Tripod head device, control method and program for the tripod head device
The pan-tilt head device automates backlash calculation by comparing motor and output shaft positions, enhancing operational efficiency and precision without manual operator input.
Patent Information
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2024-07-29
- Publication Date
- 2026-03-26
Smart Images

Figure 0007836364000001 
Figure 0007836364000002 
Figure 0007836364000003
Abstract
Description
Technical Field
[0001] The present invention relates to a pan-tilt unit, a control method for the pan-tilt unit, and a program.
Background Art
[0002] There is known a pan-tilt unit that stores an imaging device used for monitoring or video distribution purposes, and includes a pan drive unit that performs rotational drive in the horizontal direction and a tilt drive unit that performs rotational drive in the vertical direction, and can control the imaging range. The positions of such a pan drive unit and tilt drive unit are controlled by a control unit or the like.
[0003] The pan drive unit and tilt drive unit of such a pan-tilt unit may be configured to rotate an output shaft via a speed reduction mechanism having a plurality of gears from a motor shaft of a motor in order to obtain a required torque output. The speed reduction mechanism has a gap, that is, backlash, between a plurality of gears. This backlash becomes the amount of deviation in position control (also referred to as the backlash amount). Therefore, a technique for obtaining this backlash amount has been disclosed.
[0004] For example, Patent Document 1 discloses a technique of providing a position detector in each drive unit of a television camera and performing drive control of each drive unit based on the output of this position detector. In the technique of Patent Document 1, an operator operates a joystick to drive the drive unit to a preset position, operates an operation button to detect the position, and calculates the above-described deviation amount.
Prior Art Documents
Patent Documents
[0005]
Patent Document 1
Summary of the Invention
Problems to be Solved by the Invention
[0006] However, in the prior art disclosed in Patent Document 1 mentioned above, the operator needs to operate a joystick or the like, which places a heavy burden on the operator in calculating the amount of backlash.
[0007] Therefore, the present invention provides a technology that can reduce the burden on the operator when calculating the amount of backlash. [Means for solving the problem]
[0008] To solve this problem, for example, the tripod head device of the present invention has the following configuration. That is, A pan-tilt head device for changing the shooting direction of an imaging means used to photograph a subject, A drive source that outputs driving force, A reduction mechanism for reducing the driving force of the aforementioned drive source, An output shaft connected to the reduction mechanism to which the reduced driving force is transmitted and which changes the shooting direction of the imaging means, An output shaft position detection means for detecting the output shaft position, which is the position of the output shaft, Control means for controlling the drive source, Equipped with, The control means acquires at least one of the control position, which is the position of the drive source, and the output shaft position, based on predetermined conditions, and determines the amount of backlash based on the acquired control position and output shaft position. [Effects of the Invention]
[0009] According to the present invention, the burden on the operator can be reduced when calculating the amount of backlash. [Brief explanation of the drawing]
[0010] [Figure 1] A diagram illustrating the overall configuration of the control system of the pan / tilt head device according to this embodiment. [Figure 2] Plan view and side view of a tripod head device according to an embodiment. [Figure 3] A diagram illustrating the drive transmission system of the drive unit according to an embodiment. [Figure 4] A diagram illustrating the relationship between the motor control position and the output shaft position of the drive unit in the first embodiment. [Figure 5] A flowchart illustrating the backlash calculation process for the tripod head device of the first embodiment. [Figure 6] This diagram illustrates the relationship between the motor control position and the output shaft position of the drive unit in the second embodiment. [Figure 7] A flowchart illustrating the backlash calculation process for the tripod head device of the second embodiment. [Figure 8] A diagram illustrating another relationship between the motor control position and the output shaft position of the drive unit in the second embodiment. [Figure 9] A flowchart illustrating another backlash calculation process for the tripod head device of the second embodiment. [Figure 10] A block diagram showing the hardware configuration of the system control unit. [Modes for carrying out the invention]
[0011] The embodiments will be described in detail below with reference to the attached drawings. Note that the following embodiments do not limit the invention as defined in the claims. While the embodiments describe multiple features, not all of these features are essential to the invention, and the features may be combined in any way. Furthermore, in the attached drawings, identical or similar configurations are given the same reference numerals, and redundant descriptions are omitted.
[0012] (First Embodiment) Figure 1 is a diagram illustrating the overall configuration of the control system of the pan / tilt head device 1000 according to this embodiment. The overall configuration of the pan / tilt head device 1000 will be described with reference to Figure 1.
[0013] The pan-tilt unit 1000 holds the imaging device 2000 for photographing a subject and changes the photographing direction including the pan direction and the tilt direction of the imaging device 2000. The pan-tilt unit 1000 is connected to the imaging device 2000 and the client device 3000. The pan-tilt unit 1000 includes a pan drive unit 1004, a tilt drive unit 1005, a system control unit 1006, and a communication unit 1007.
[0014] The pan drive unit 1004 performs the pan operation of the pan-tilt unit 1000. The pan operation is an operation of rotating the imaging device 2000 in the left-right direction (i.e., the horizontal direction), which is a rotational operation around the vertical axis. The pan drive unit 1004 is communicably connected to the system control unit 1006 so as to be able to transmit and receive signals such as rotation instructions. The pan drive unit 1004 realizes pan driving by a mechanism unit that performs the pan operation, an actuator such as a brushless DC motor, an encoder that detects the pan position, and the like. In the present embodiment, the pan drive unit 1004 is built in either the bottom case 1101 or the turntable 1102 described later.
[0015] The tilt drive unit 1005 performs the tilt operation of the pan-tilt unit 1000. The tilt operation is an operation of rotating the imaging device 2000 in the up-down direction (i.e., the vertical direction), which is a rotational operation around the horizontal axis extending left and right. The tilt drive unit 1005 is communicably connected to the system control unit 1006 so as to be able to transmit and receive signals such as rotation instructions. The tilt drive unit 1005 realizes tilt driving by a mechanism unit that performs the tilt operation, an actuator such as a brushless DC motor, an encoder that detects the tilt position, and the like. In the present embodiment, the tilt drive unit 1005 is built in either the column 1103 for the camera head or the camera head 1104 described later.
[0016] The system control unit 1006 is responsible for the overall control of the pan / tilt head device 1000. The system control unit 1006 is equipped with a processor such as a CPU (Central Processing Unit). The system control unit 1006 is connected to the client device 3000, which is an information processing device (also called a computer), via the communication unit 1007, enabling it to send and receive signals. The system control unit 1006 communicates signals, including commands and responses, with the client device 3000 to control the pan / tilt head device 1000. In other words, the system control unit 1006 receives commands transmitted from the client device 3000, analyzes the acquired commands, and executes processing according to the commands. Then, the system control unit 1006 sends a response to the command to the client device 3000. For example, the system control unit 1006 controls the imaging device 2000 based on instructions for camera control commands. The system control unit 1006 controls the pan drive unit 1004 and the tilt drive unit 1005 based on commands related to pan-tilt control to rotate the imaging direction of the imaging device 2000 in the pan and tilt directions. The system control unit 1006 receives image data, which is the data of the image generated when the imaging device 2000 captures a subject. The system control unit 1006 transmits the received image data to the client device 3000 via the communication unit 1007. The term "image" may include still images, moving images, video footage, and their data. The system control unit 1006 is equipped with non-volatile memory and stores and registers various types of data, such as preset positions, which will be described later.
[0017] The communication unit 1007 is connected to the client device 3000 via a network and serial communication, and transmits and receives signals to each other. The communication unit 1007 receives commands from the client device 3000 regarding pan-tilt control and camera control. The communication unit 1007 transmits the response from the system control unit 1006 to the client device 3000. The communication unit 1007 transmits the image data received from the imaging device 2000 to the client device 3000.
[0018] The imaging device 2000 comprises a lens, an image sensor, and a control circuit. The imaging device 2000 receives light from a subject that is imaged by an imaging optical system including the lens, and converts the light image of the subject into an electrical signal by photoelectric conversion. The imaging device 2000 generates image data by performing image processing such as development, compression, and encoding on the photoelectrically converted electrical signal. The imaging device 2000 is equipped with an optical zoom control mechanism that can change the imaging angle of view. The imaging device 2000 is equipped with a focus control mechanism that can adjust the focus of the captured image. The imaging device 2000 is connected to the tripod head unit 1000. Based on instructions from the client device 3000 obtained from the tripod head unit 1000, the imaging device 2000 adjusts the shooting angle of view by zoom control and adjusts the focus of the captured image by focusing. The imaging device 2000 transmits the generated image data to the tripod head unit 1000. As a result, the image data is transmitted to the client device 3000 via the pan / tilt head device 1000.
[0019] Figure 10 is a block diagram showing the hardware configuration of the system control unit 1006. The system control unit 1006 is, for example, a computer. The system control unit 1006 includes a processor 1191, a memory 1192, a storage 1193, an input IF 1195, an output IF 1196, and a bus 1197. The processor 1191, memory 1192, storage 1193, input IF 1195, and output IF 1196 are connected to each other via the bus 1197 so that they can send and receive information.
[0020] The processor 1191 is an arithmetic processing unit, such as a CPU (Central Processing Unit). The system control unit 1006 may have other processors, such as an MPU (Micro Processing Unit), a GPU (Graphics Processing Unit), and a QPU (Quantum Processing Unit), in place of or in addition to the CPU. The processor 1191 performs various functions and processes by reading programs stored in the storage 1193 and loading them into the memory 1192. For example, the processor 1191 executes each step of the backlash calculation process described later by reading a computer program. Some or all of the steps of the backlash calculation process may be performed by one or more circuits, such as an ASIC (Application Specific Integrated Circuit) and an FPGA (Field Programmable Gate Array).
[0021] Memory 1192 is a high-speed read / write storage device, such as RAM (Random Access Memory). Memory 1192 functions as a work area when the processor 1191 executes a program. Memory 1192 temporarily stores the program and parameters necessary for program execution. For example, in the backlash calculation process, memory 1192 stores the detected motor control position, output shaft position, and the backlash amount which is the processing result.
[0022] The storage device 1193 is a non-volatile storage device such as an HDD (Hard Disk Drive) or an SSD (Solid State Drive). The storage device 1193 retains programs, parameters necessary for program execution, and the results of program execution even when power is not supplied.
[0023] Input IF1195 is an interface for receiving information from input devices. These input devices include, for example, a mouse, keyboard, or touch panel.
[0024] Output IF1196 is an interface for outputting information such as processing results to a display device such as a monitor.
[0025] Next, with reference to Figure 2, the details of the mechanical configuration of the pan / tilt head device 1000 will be described. Figure 2 is a plan view and a side view of the pan / tilt head device 1000 according to this embodiment. Figure 2(a) is a plan view of the mechanical mechanism of the pan / tilt head device 1000 from above along the vertical axis. Figure 2(b) is a side view of the pan / tilt head device 1000. As shown in Figure 2, the pan / tilt head device 1000 includes a bottom case 1101, a turntable 1102, a support column for the camera head 1103, and a camera head 1104. In this embodiment, the imaging device 2000 is built into the camera head 1104. In this embodiment, the pan drive unit 1004 is built into either the bottom case 1101 or the turntable 1102, which will be described later.
[0026] The bottom case 1101 functions as the base for the entire pan head unit 1000, including the pan drive unit 1004 and the tilt drive unit 1005. The bottom case 1101 is positioned beneath the turntable 1102.
[0027] The turntable 1102, with the camera head support column 1103 (described later) mounted on it, rotates around its vertical axis to drive the panning motion, that is, to perform the panning operation of the pan / tilt head device 1000. The turntable 1102 can rotate from -175 degrees to +175 degrees in the panning direction.
[0028] In other words, the mechanism, actuator, and encoder that perform the panning motion of the pan drive unit 1004 are built into either the bottom case 1101 or the turntable 1102. This allows the pan drive unit 1004 to rotate the imaging device 2000 in the pan direction from -175 degrees to +175 degrees. In this embodiment, the pan drive unit 1004 is built into either the bottom case 1101 or the turntable 1102, but other configurations are also possible. For example, the pan drive unit 1004 may not be built into either the bottom case 1101 or the turntable 1102, but may be located in another component.
[0029] The camera head support column 1103 extends vertically and supports the camera head 1104, which will be described later. The camera head support column 1103 is positioned on the central axis of the turntable 1102. The camera head support column 1103 holds the camera head 1104 on the side opposite to the turntable 1102 (in this case, the upper end).
[0030] The camera head 1104 is hollow. The camera head 1104 houses the imaging device 2000. The camera head 1104 is positioned at the upper end of the camera head support column 1103. The camera head 1104 is driven in the tilt direction, that is, it performs the tilting operation of the pan / tilt head device 1000, with an axis perpendicular to the vertical axis as its central axis. The camera head 1104 can rotate from -45 degrees diagonally downwards forward to +90 degrees upwards, with the horizontal direction being 0 degrees.
[0031] In other words, the mechanism, actuator, and encoder that perform the tilt operation of the tilt drive unit 1005 are built into either the camera head support column 1103 or the camera head 1104. As a result, the tilt drive unit 1005 can rotate the imaging device 2000 from -45 degrees diagonally downwards forward to +90 degrees upwards.
[0032] Furthermore, in this embodiment, the tilt drive unit 1005 is built into either the camera head support column 1103 or the camera head 1104, but other configurations are also possible. For example, the tilt drive unit 1005 may not be built into either the camera head support column 1103 or the camera head 1104, but may be located on another component.
[0033] Thus, the pan / tilt mount device 1000 of this embodiment can change the imaging direction by rotating the camera head 1104 in the pan and tilt directions, allowing the imaging device 2000 to capture images. Note that the drive ranges in the pan and tilt directions in this embodiment are just examples and are not limited thereto. For example, the drive in the pan and tilt directions may be configured to rotate endlessly.
[0034] Figure 3 is a diagram illustrating the drive transmission systems of the pan drive unit 1004 and the tilt drive unit 1005. Referring to Figure 3, the configuration of the internal drive transmission systems of the pan drive unit 1004 and the tilt drive unit 1005 will be described. The pan drive unit 1004 and the tilt drive unit 1005 have generally the same configuration. The pan drive unit 1004 and the tilt drive unit 1005 include a motor 1201, a motor shaft encoder 1202, a reduction mechanism 1203, an output shaft 1204, and an output shaft encoder 1205.
[0035] Motor 1201 outputs driving force as rotational driving force and functions as a drive source for the pan drive unit 1004 and the tilt drive unit 1005. The rotation of motor 1201 rotates the output shaft 1204, which is the rotation axis for pan or tilt, via the reduction mechanism 1203. As a result, motor 1201 rotates the imaging device 2000 in either the pan direction or the tilt direction. Motor 1201 may be, for example, a brushless DC motor.
[0036] The motor shaft encoder 1202 is mounted on the motor shaft. The motor shaft encoder 1202 may be an incremental encoder or the like. The motor shaft encoder 1202 functions as a position detector that detects the position of the motor shaft (also called the motor control position). The motor shaft encoder 1202 outputs the detected motor shaft position information to the processor 1191 of the system control unit 1006. The motor shaft encoder 1202 is an example of a drive control position detection means.
[0037] The reduction mechanism 1203 consists of multiple gears and belts. The reduction mechanism 1203 reduces the rotational speed of the motor 1201, i.e., reduces the driving force, and outputs the necessary torque to the output shaft 1204.
[0038] The output shaft 1204 is connected to the reduction mechanism 1203. Therefore, the output shaft 1204 receives the driving force from the reduced motor 1201 via the reduction mechanism 1203 and outputs the transmitted rotational drive. This causes the output shaft 1204 to rotate the camera head 1104 in the pan or tilt direction, thereby changing the shooting direction of the imaging device 2000.
[0039] The output shaft encoder 1205 is provided on the output shaft 1204. The output shaft encoder 1205 may be an absolute value encoder or the like. The output shaft encoder 1205 functions as a position detector that detects the position (also called the output shaft position) of the output shafts of the pan drive unit 1004 and the tilt drive unit 1005. The output shaft encoder 1205 outputs the detected output shaft position information to the processor 1191 of the system control unit 1006. The output shaft encoder 1205 is an example of an output shaft position detection means.
[0040] Here, a brushless DC motor is used as an example for the drive source motor 1201, but the motor 1201 is not limited to this; other types of actuators may be used. Also, although a configuration with an incremental encoder as the motor shaft position detector and an absolute encoder as the output shaft position detector is shown, other types of position detectors may be used. Furthermore, although a configuration in which the position of the output shaft 1204 is directly detected using the output shaft encoder 1205 provided on the output shaft 1204 is shown, it is not limited to this. It is also possible to have an encoder provided on a rotating shaft that rotates from the output shaft 1204 via a reduction mechanism (not shown), and to indirectly detect the position on the output shaft 1204 using that encoder.
[0041] In this embodiment, the processor 1191 of the system control unit 1006 of the pan-head device 1000 registers preset information in the storage 1193 that associates the position of the pan drive unit 1004, the position of the tilt drive unit 1005, the zoom control position of the imaging device 2000, and a preset number. Alternatively, the processor 1191 may register preset information that associates at least one of the positions of the pan drive unit 1004, the tilt drive unit 1005, and the zoom control position with a preset number. Furthermore, the processor 1191 may register preset information that includes image quality settings and other information in addition to the positions of the pan drive unit 1004, the tilt drive unit 1005, and the zoom control position.
[0042] Here, the pan-head unit 1000 is configured to allow remote control of the pan drive unit 1004 and the tilt drive unit 1005 via a network and dedicated line. Therefore, when the processor 1191 receives a predetermined command and a registered preset number from, for example, a remote operator, it retrieves the preset information associated with the preset number. Based on this preset information, the processor 1191 controls the pan drive unit 1004 and the tilt drive unit 1005, etc., to execute a preset function that moves them to the preset position. Furthermore, the system control unit 1006 instructs the pan drive unit 1004 and the tilt drive unit 1005 to move to the preset position in a predetermined time, realizing a function called a shot that controls the pan and tilt movement times in a synchronized manner.
[0043] Figure 4 illustrates the relationship between the motor control position and the output shaft position of the drive unit in the first embodiment. In Figure 4, the horizontal axis represents the time axis, and the vertical axes represent the motor control position and the output shaft position. The motor control position is the position detected by the motor shaft encoder 1202. The output shaft position is the position detected by the output shaft encoder 1205. The solid line shows the movement trajectory LA of the motor control position detected by the motor shaft encoder 1202. The dotted line shows the movement trajectory LB of the output shaft position detected by the output shaft encoder 1205.
[0044] Assume that at time t0, motor 1201 is at position me1 in the positive direction. The system control unit 1006 drives motor 1201 from position me1 in the negative direction to position me0 at 0 degrees. At this time, the system control unit 1006 controls motor 1201 based on the motor control position detected by motor shaft encoder 1202. In this case, the motor control position changes linearly, as shown by the movement trajectory LA. On the other hand, even if motor 1201 rotates, due to the backlash of the reduction mechanism 1203, there is a period of time from the start of driving during which the output shaft 1204 does not rotate. Therefore, the output shaft position, which is the value of the output shaft encoder 1205, does not change from time t0 to time t1.
[0045] Subsequently, the output shaft position detected by the output shaft encoder 1205 begins to change after time t1, as shown in the movement trajectory LB, and changes linearly thereafter. Then, at time t2, when the motor control position detected by the motor shaft encoder 1202 reaches 0 degrees, the output shaft position detected by the output shaft encoder 1205 does not reach 0 degrees, but takes the value of position oe1.
[0046] Next, the system control unit 1006 drives the motor 1201 from position me0 to position me2 in the negative direction. Assume that at time t3, the motor 1201 is at position me2 in the negative direction. The system control unit 1006 drives the motor 1201 in the positive direction from position me2 to position me0 at 0 degrees. At this time, the system control unit 1006 controls the motor 1201 based on the motor control position detected by the motor shaft encoder 1202. In this control, the motor control position changes linearly as shown in the movement trajectory LA. Here, for a certain period from the start of driving, there is a section in which the output shaft 1204 does not rotate even when the motor rotates due to the backlash of the reduction mechanism 1203. Therefore, the output shaft position detected by the output shaft encoder 1205 does not change from time t3 to time t4, as shown in the movement trajectory LB.
[0047] After this, the movement trajectory LB of the output shaft encoder 1205 begins to change after time t4 and changes linearly thereafter. Here, the time between time t3 and time t4 is approximately the same as the time between time t0 and time t1. Due to the change in the motor control position between time t3 and time t4, the output shaft position approaches the motor control position, and at time t4, the output shaft position and the motor control position are at the same position. Then, at time t5, when the motor 1201 reaches the 0-degree position, the output shaft position detected by the output shaft encoder 1205 is approximately the 0-degree position оe2, as shown in the movement trajectory LB. Here, the difference between the values of position оe1 and position оe2 is the amount of backlash. Therefore, the system control unit 1006 can calculate the amount of backlash by calculating the difference in output shaft position when controlled to the same position (in this case, the 0-degree position) from both the positive and negative directions, without requiring any operation from the operator. The system control unit 1006 may also calculate the amount of backlash by calculating the difference between the motor control position and the output shaft position at time t2. In other words, the system control unit 1006 may calculate the amount of backlash by calculating the difference between the motor control position and the output shaft position at the time when the motor control position becomes 0 degrees. Furthermore, the system control unit 1006 may calculate the amount of backlash by calculating the difference between the amount of movement of the motor control position and the amount of movement of the output shaft position from time t1 onward, when the output shaft position begins to change.
[0048] Here, the system control unit 1006 calculates the difference in detected positions by the motor shaft encoder 1202 and the output shaft encoder 1205 when controlled from the positive and negative directions, respectively, at the 0-degree position, as the amount of backlash. However, it is not limited to this. The system control unit 1006 may also calculate the difference in positions of the motor shaft and the output shaft when controlled to the same position from the positive and negative directions, respectively, at a different position, as the amount of backlash.
[0049] Figure 5 is a flowchart illustrating the backlash calculation process of the pan / tilt head device 1000 in the first embodiment. In this flowchart, the processor 1191 of the system control unit 1006 reads a computer program from the storage 1193 and loads the program and various data into the memory 1192 to execute this process. When the system control unit 1006 receives a command to instruct the calculation of backlash, it executes the flowchart in Figure 5. In this flowchart, the system control unit 1006 acquires the output axis position based on predetermined conditions and calculates the amount of backlash based on the output axis position. For simplicity, this embodiment describes the control process in the pan direction, but the control process in the tilt direction is performed using a similar flowchart.
[0050] In step S1001, the system control unit 1006 controls the motor 1201 to drive the pan drive unit 1004 to a predetermined position in the positive direction by a predetermined amount of movement. The amount of movement here is a predetermined amount that eliminates backlash and is sufficient, for example, 10 degrees. In this flowchart, the amount of movement of the pan drive unit 1004 is, for example, the motor control position detected by the motor shaft encoder 1202 of the motor 1201, and is the movement trajectory LA.
[0051] In step S1002, the system control unit 1006 controls the motor 1201 to drive the pan drive unit 1004 to the 0-degree position. Since the pan drive unit 1004 was driven from the +10-degree position to 0 degrees in step S1001, the system control unit 1006 will drive the pan drive unit 1004 10 degrees in the negative direction. Driving to the 0-degree position in step S1002 is just one example of a predetermined condition.
[0052] In step S1003, the system control unit 1006 obtains the output shaft position from the output shaft encoder 1205 as the position of the output shaft of the pan drive unit 1004. For example, the system control unit 1006 obtains +0.01 degrees as the output shaft position.
[0053] In step S1004, the system control unit 1006 controls the motor 1201 to drive the pan drive unit 1004 to a predetermined position in the negative direction. The amount of movement here is similarly sufficient to eliminate backlash, for example, 10 degrees.
[0054] In step S1005, the system control unit 1006 controls the motor 1201 to drive the pan drive unit 1004 to the 0-degree position. In step S1004, the pan drive unit 1004 was driven from the -10-degree position to 0 degrees, so it is now driven 10 degrees in the positive direction. Driving to the 0-degree position in step S1005 is just one example of a predetermined condition.
[0055] In step S1006, the system control unit 1006 obtains the output shaft position of the pan drive unit 1004 from the output shaft encoder 1205. For example, the system control unit 1006 obtains -0.02 degrees as the output shaft position.
[0056] In step S1007, the system control unit 1006 calculates the amount of backlash from the acquired output shaft position. Specifically, the system control unit 1006 calculates the amount of backlash from the difference between the output shaft position when driven from a position of 10 degrees in the positive direction to a position of 0 degrees and the output shaft position when driven from a position of 10 degrees in the negative direction to a position of 0 degrees. For example, in the case of the above value, the system control unit 1006 calculates the amount of backlash as 0.03 degrees from the following formula.
[0057] 0.01 - (-0.02) = 0.03 degrees As a result, the system control unit 1006 terminates this process.
[0058] The system control unit 1006 processes the tilt control of the pan / tilt head device 1000 in the same way as the pan control described above.
[0059] In this way, the pan head device 1000 can determine the amount of backlash included in the pan drive unit 1004 and the tilt drive unit 1005 based on the motor control position and output shaft position when the pan drive unit 1004 and the tilt drive unit 1005 are controlled to the same position from different directions. As a result, the pan head device 1000 can easily calculate the amount of backlash without requiring any operation from the operator. Furthermore, by using the determined amount of backlash in the control of the pan drive and tilt drive, the pan head device 1000 can reduce the stopping position error caused by backlash.
[0060] Here, we have shown an example of a configuration in which a brushless DC motor is used as the drive source motor 1201 for the pan drive unit 1004 and the tilt drive unit 1005, and a motor shaft encoder 1202 is provided on the motor shaft to detect the position of the motor, and the motor 1201 is controlled using the motor control position determined by the motor shaft encoder 1202 as the control amount for the motor 1201, but the system is not limited to this. For example, a similar method may be used in a configuration in which a stepping motor is used as the drive source motor 1201, and the position is controlled using the number of pulses or steps of the stepping motor as the control amount.
[0061] In the first embodiment described above, the amount of backlash was calculated by driving in both the positive and negative directions, but the calculation method is not limited to this. For example, the system control unit 1006 may drive the motor 1201 in either direction and calculate the amount of backlash based on the motor control position and the output shaft position when the motor control position is driven to a predetermined position (e.g., the 0-degree position). Specifically, the system control unit 1006 may drive the motor 1201 in either direction and calculate the amount of backlash based on the difference between the amount of movement of the output shaft position and the amount of movement of the motor control position (in this case, the 0-degree position) when the motor control position is driven to a predetermined position (e.g., the 0-degree position).
[0062] (Second embodiment) Next, referring to Figures 6 to 9, the method for calculating backlash at the start of drive during reversal operation will be mainly described for the second embodiment. For components similar to those in the first embodiment, the same reference numerals used previously will be used, and their detailed explanations will be omitted. The explanation will focus on the differences from the first embodiment. This method of omitting explanations will be the same for other embodiments described later.
[0063] Figure 6 illustrates the relationship between the motor control position and the output shaft position of the drive unit in the second embodiment. In Figure 6, the horizontal axis represents the time axis, and the vertical axis represents the motor control position, i.e., the value of the motor shaft encoder 1202, and the output shaft position, i.e., the value of the output shaft encoder 1205. The solid line shows the movement trajectory LA of the motor shaft encoder 1202. The dotted line shows the movement trajectory LB of the output shaft encoder 1205.
[0064] Figure 6 shows the behavior during reversal, that is, when the motor is driven in the negative direction and then starts moving in the positive direction. Assume that at time t0, the motor 1201 is at position me0 at 0 degrees. The system control unit 1006 drives the motor 1201 from position me0 in the positive direction to position me2. At this time, the system control unit 1006 controls the motor 1201 based on the motor control position, which is the value of the motor shaft encoder 1202. In this case, the motor shaft encoder 1202 changes linearly, as shown by the movement trajectory LA. On the other hand, for a certain period from the start of driving, there is a section in which the output shaft 1204 does not rotate even though the motor 1201 rotates due to the backlash of the reduction mechanism 1203. Therefore, the output shaft position, which is the value of the output shaft encoder 1205, does not change from time t0 to time t1. Then, the output shaft position detected by the output shaft encoder 1205 begins to change after time t1, that is, after the motor shaft encoder 1202 has driven to position me1, as shown in the movement trajectory LB, and thereafter changes linearly. At time t2, when the motor control position detected by the motor shaft encoder 1202 reaches position me2, the output shaft position detected by the output shaft encoder 1205 becomes a position oe2, which is slightly short of the target position.
[0065] Here, the difference between the position me0 value and the position me1 value detected by the motor shaft encoder 1202 is the amount of backlash. In this way, the amount of backlash can be calculated from the motor shaft encoder value by observing the change in the output shaft encoder 1205 at the start of the drive during the reversal operation.
[0066] Figure 7 is a flowchart showing the backlash calculation process of the pan / tilt head device 1000 in the second embodiment. In this flowchart, the processor 1191 of the system control unit 1006 reads a computer program from the storage 1193 and loads various programs and data into the memory 1192 to execute this process. When the system control unit 1006 receives a pan drive command, it executes the flowchart in Figure 7. In this flowchart, the system control unit 1006 acquires the motor control position based on predetermined conditions and calculates the amount of backlash based on the motor control position. For simplicity, this embodiment describes the control process in the pan direction, but the control process in the tilt direction is performed using a similar flowchart.
[0067] In step S2001, the system control unit 1006 determines whether the new driving direction is different from the previous driving direction. If the system control unit 1006 determines that the driving direction is different, i.e., that the driving direction has been reversed, it proceeds to step S2002. On the other hand, if the system control unit 1006 determines that the driving direction is the same, it terminates this process.
[0068] In step S2002, the system control unit 1006 obtains the motor control position and output shaft position of the pan drive at the start of driving after reversal from the motor shaft encoder 1202 and the output shaft encoder 1205. Here, the system control unit 1006 obtains, for example, 0.01 degrees for both the motor control position and the output shaft position. The start of driving after reversal is an example of a predetermined condition.
[0069] In step S2003, the system control unit 1006 controls the motor 1201 to start driving the pan drive unit 1004.
[0070] In step S2004, the system control unit 1006 determines whether or not there has been a change in the output shaft position. Specifically, the system control unit 1006 obtains the output shaft position of the pan drive unit 1004 from the output shaft encoder 1205. The system control unit 1006 compares the newly obtained output shaft position with the output shaft position at the start of the drive to determine whether or not there has been a change. If the system control unit 1006 determines that the output shaft position has changed, it proceeds to S2005. On the other hand, if the system control unit 1006 determines that there has been no change in the output shaft position, it returns to the process in S2004 and continues processing until it determines that there has been a change. "There has been a change in the output shaft position" is just one example of a predetermined condition.
[0071] In step S2005, the system control unit 1006 obtains the motor control position from the motor shaft encoder 1202. Here, for example, 0.03 degrees is obtained as the motor control position.
[0072] In step S2006, the system control unit 1006 calculates the amount of backlash from the difference between the motor control position at the start of driving and the motor control position at the start of the change in the output shaft position detected by the output shaft encoder 1205. For example, in the case of the above value, the system control unit 1006 calculates the amount of backlash as 0.02 degrees from the following formula.
[0073] 0.03 - 0.01 = 0.02 degrees As a result, the system control unit 1006 terminates this process.
[0074] The system control unit 1006 processes the tilt control of the pan / tilt head device 1000 in the same way as the pan control described above.
[0075] In this way, the pan / tilt head device 1000 determines the amount of backlash included in the drive unit using the motor control position during the reversal operation of the pan drive unit 1004 and the tilt drive unit 1005, and the motor control position at the start of the change in the output shaft position. As a result, the pan / tilt head device 1000 can calculate the amount of backlash without requiring any operation from the operator. Furthermore, by using the determined amount of backlash in the control, the pan / tilt head device 1000 can reduce the stopping position error caused by backlash.
[0076] Figure 8 illustrates another relationship between the motor control position and the output shaft position of the drive unit in the second embodiment. In Figure 8, the horizontal axis represents the time axis, and the vertical axis represents the motor control position, i.e., the value of the motor shaft encoder 1202, and the output shaft position, i.e., the value of the output shaft encoder 1205. The solid line represents the movement trajectory LA of the motor shaft encoder 1202. The dotted line represents the movement trajectory LB of the output shaft encoder 1205.
[0077] Figure 8 shows the behavior during reversal, that is, when the motor is driven in the negative direction and then starts moving in the positive direction. Assume that at time t0, the motor 1201 is at position me0 at 0 degrees. The system control unit 1006 drives the motor 1201 from position me0 in the positive direction to position me2. At this time, the system control unit 1006 controls the motor 1201 based on the motor control position, which is the value of the motor shaft encoder 1202. During this time, the movement trajectory LA of the motor shaft encoder 1202 changes linearly. On the other hand, there is a period when the output shaft position, which is the value of the output shaft encoder 1205, is driven by a small amount from the start of the drive. Specifically, from time t0 to time t1, that is, until the motor control position detected by the motor shaft encoder 1202 becomes position me1, the output shaft position detected by the output shaft encoder 1205 changes to position me1. This change shows a phenomenon that can be seen due to the characteristics of the drive transmission system, in particular the spring component of the drive transmission system. This occurs because, during the drive of motor 1201 before its reversal, the backlash becomes compressed at the point when the drive in the negative direction is completed, and the spring component force of the drive transmission system is charged into the drive transmission system.
[0078] Subsequently, when the reverse operation is performed, the charged force is released, causing the output shaft 1204 to be driven by a small amount, as shown from time t0 to time t1. After the small amount of driving, as described above, there is a period of time during which the output shaft 1204 does not rotate even if the motor 1201 rotates due to the backlash of the reduction mechanism 1203. Specifically, the output shaft position detected by the output shaft encoder 1205 does not change from time t1 to time t2. After time t2, that is, after the motor control position detected by the motor shaft encoder 1202 exceeds position me2, the output shaft position detected by the output shaft encoder 1205 begins to change. From then on, the output shaft position detected by the output shaft encoder 1205 follows a linearly changing movement trajectory LB. At time t3, when the motor control position detected by the motor shaft encoder 1202 reaches position me3, the output shaft position detected by the output shaft encoder 1205 takes the value of position oe3, which is slightly short of the target position.
[0079] In the case of a drive mechanism with such characteristics, the amount of backlash can be measured not at the start of driving, but by the difference between the value of position me1 and the value of position me2 detected by the motor shaft encoder 1202 from the point when the change after a small change following the start of driving ceases until the next change occurs.
[0080] Figure 9 is a flowchart illustrating another backlash calculation process for the pan / tilt head device 1000 of the second embodiment. This flowchart shows that the processor 1191 of the system control unit 1006 executes this process by reading a computer program from the storage 1193 and loading the program and various data into the memory 1192. The system control unit 1006 executes the flowchart in Figure 9 when it receives a pan drive command. For simplicity, this embodiment describes the control process in the pan direction, but the control process in the tilt direction is performed using a similar flowchart.
[0081] In step S3001, the system control unit 1006 determines whether the new driving direction is different from the previous driving direction. If the system control unit 1006 determines that the driving direction is different, i.e., that the driving direction has been reversed, it proceeds to step S3002. On the other hand, if the system control unit 1006 determines that the driving direction is the same, it terminates this process.
[0082] In step S3002, the system control unit 1006 obtains the motor control position and output shaft position of the pan drive unit 1004 at the start of driving after reversal from the motor shaft encoder 1202 and the output shaft encoder 1205.
[0083] In step S3003, the system control unit 1006 controls the motor 1201 to start driving the pan drive unit 1004.
[0084] In step S3004, the system control unit 1006 determines whether or not there is a change in the output shaft position. Specifically, the system control unit 1006 obtains the output shaft position of the pan drive unit 1004 from the output shaft encoder 1205. The system control unit 1006 compares the newly obtained output shaft position with the previously obtained output shaft position and determines whether or not there is no change, that is, whether or not the change has stopped. If the system control unit 1006 determines that the change has stopped and there is no change, it proceeds to S3005. On the other hand, if the system control unit 1006 determines that there is a change, it repeats step S3004 until it determines that the change has stopped and there is no change. The fact that there is no change in the output shaft position after reversal is one example of a predetermined condition.
[0085] In step S3005, the system control unit 1006 obtains the motor control position and output shaft position of the pan drive unit 1004 from the motor shaft encoder 1202 and the output shaft encoder 1205. Here, the system control unit 1006 obtains, for example, 0.02 degrees as the motor control position.
[0086] In step S3006, the system control unit 1006 determines whether there has been a change in the stopped output shaft position. Specifically, the system control unit 1006 obtains the output shaft position of the pan drive unit 1004 from the output shaft encoder 1205. The system control unit 1006 compares the newly obtained output shaft position with the output shaft position obtained in step S3005 at the point when the change in the output shaft position ceased, and determines whether the output shaft position has changed. If the system control unit 1006 determines that the output shaft position has changed, that is, that the change in the output shaft position that had stopped has resumed, it proceeds to S3007. On the other hand, if the system control unit 1006 determines that the output shaft has not changed, it returns to the process in S3006 and continues processing until it determines that there has been a change. The resumption of a change in the output shaft position that had stopped is one example of a predetermined condition.
[0087] In step S3007, the system control unit 1006 obtains the motor control position from the motor shaft encoder 1202. Here, the system control unit 1006 obtains, for example, 0.03 degrees as the motor control position.
[0088] In step S3008, the system control unit 1006 calculates the amount of backlash based on the difference between the motor control position at the point when the change in the output shaft position stops and the motor control position at the point when the change in the output shaft position resumes. The point when the change in the output shaft position stops is time t1 in Figure 8. The point when the change in the output shaft position resumes is time t2 in Figure 8. For example, in the case of the above values, the system control unit 1006 calculates the amount of backlash as 0.01 degrees from the following formula.
[0089] 0.03 - 0.02 = 0.01 degrees As a result, the system control unit 1006 terminates this process.
[0090] The system control unit 1006 processes the tilt control of the pan / tilt head device 1000 in the same way as the pan control described above.
[0091] In this way, the pan / tilt head unit 1000 determines the amount of backlash included in the drive unit using the motor control position at the time the change in the output shaft position stops and resumes after the start of the reversal operation of the pan drive unit 1004 and the tilt drive unit 1005. As a result, the pan / tilt head unit 1000 can calculate the amount of backlash without requiring any operation by the operator. Furthermore, by using the determined amount of backlash in the control, the pan / tilt head unit 1000 can reduce the stopping position error caused by backlash.
[0092] Here, we have shown the case where the reversal operation is performed at the 0-degree position, but the measurement is not limited to this, and can also be taken when the reversal operation is performed at a predetermined position other than 0 degrees. Also, here we have shown the case where the reversal operation is performed from the negative direction to the positive direction, but the measurement is not limited to when the reversal operation is performed from the positive direction to the negative direction.
[0093] The embodiments described above may be combined. For example, the backlash calculation process of each embodiment may be configured to be executable on a single pan / tilt head device, allowing the operator to select which one to use.
[0094] In the above-described embodiment, an example was given in which the imaging device 2000 and the pan / tilt head device 1000 are separate components, but the configuration of the pan / tilt head device 100 is not limited to this. For example, the pan / tilt head device may be integrated with the imaging device.
[0095] (Other examples) The present invention can also be realized by supplying a program that implements one or more of the functions of the above-described embodiments to a system or device via a network or storage medium, and by having one or more processors in the computer of that system or device read and execute the program. Furthermore, the present invention can also be realized by a circuit (e.g., an ASIC) that implements one or more functions.
[0096] This disclosure includes the following pan / tilt head devices, control methods for pan / tilt head devices, and programs. (Item 1) A pan-tilt head device for changing the shooting direction of an imaging means used to photograph a subject, A drive source that outputs driving force, A reduction mechanism for reducing the driving force of the aforementioned drive source, An output shaft connected to the reduction mechanism to which the reduced driving force is transmitted and which changes the shooting direction of the imaging means, An output shaft position detection means for detecting the output shaft position, which is the position of the output shaft, Control means for controlling the drive source, Equipped with, The control means acquires at least one of the control position, which is the position of the drive source, and the output shaft position, based on predetermined conditions, and determines the amount of backlash based on the acquired control position and output shaft position. A tripod head device characterized by the following features. (Item 2) A drive control position detection means for detecting the control position of the drive source A tripod head device as described in item 1, characterized by being equipped with the following features. (Item 3) The aforementioned drive source is a stepper motor, The control means uses the number of pulses of the stepping motor as the control position of the drive source. A tripod head device as described in item 1, characterized by the features described herein. (Item 4) The control means is The amount of backlash is calculated based on the first output shaft position at the time the drive source is driven to a predetermined position in the first direction. A tripod head device as described in any one of items 1 to 3, characterized by the above. (Item 5) The control means is The amount of backlash is calculated based on the difference between the second output shaft position and the first output shaft position when the drive source is driven to the predetermined position in a second direction opposite to the first direction. The tripod head device described in item 4, characterized by the features described herein. (Item 6) The control means is Before driving the drive source in the first direction, it is driven in a second direction opposite to the first direction by an amount of movement that eliminates the amount of backlash. The tripod head device described in item 4. (Item 7) The control means is The first control position of the drive source at the start of driving when the drive source, which is being driven in a first direction, starts driving in a second direction opposite to the first direction, is obtained. The second control position of the drive source is obtained after the start of the drive and at the point when the output shaft position changes. The difference between the first control position and the second control position is calculated as the amount of backlash. A tripod head device according to any one of items 1 to 6, characterized by the features described in item 1 to 6. (Item 8) The control means is The first control position of the drive source is obtained when the drive source, which is being driven in a first direction, starts to be driven in a second direction opposite to the first direction, and there is no longer any change in the output shaft position. The second control position of the drive source is obtained at the point when the change in the output shaft position resumes. The difference between the first control position and the second control position is calculated as the amount of backlash. A tripod head device as described in any one of items 1 to 7, characterized by the features described in item 1 to 7. (Item 9) A drive source that outputs driving force, A reduction mechanism for reducing the driving force of the aforementioned drive source, An output shaft connected to the reduction mechanism to which the reduced driving force is transmitted and which changes the shooting direction of the imaging means, An output shaft position detection means for detecting the output shaft position, which is the position of the output shaft, Control means for controlling the drive source, A control method for a pan / tilt head device that changes the shooting direction of an imaging means for photographing a subject, comprising: Based on predetermined conditions, at least one of the control position, which is the position of the drive source, and the output shaft position is obtained, and the amount of backlash is determined based on the obtained control position and output shaft position. A method for controlling a tripod head device, characterized by the features described above. (Item 10) A program to cause a computer to function as a control means for the pan / tilt head device described in any one of items 1 through 8.
[0097] The invention is not limited to the embodiments described above, and various modifications and variations are possible without departing from the spirit and scope of the invention. Accordingly, claims are attached to disclose the scope of the invention. [Explanation of Symbols]
[0098] 1000...Tripod head unit, 2000...Imaging unit, 3000...Client unit, 1004...Pan drive unit, 1005...Tilt drive unit, 1006...System control unit, 1201...Motor, 1202...Motor shaft encoder, 1203...Reduction mechanism, 1204...Output shaft, 1205...Output shaft encoder.
Claims
1. A pan-tilt head device for changing the shooting direction of an imaging means used to photograph a subject, A drive source that outputs driving force, A reduction mechanism for reducing the driving force of the aforementioned drive source, An output shaft connected to the reduction mechanism to which the reduced driving force is transmitted and which changes the shooting direction of the imaging means, An output shaft position detection means for detecting the output shaft position, which is the position of the output shaft, Control means for controlling the drive source, Equipped with, The control means acquires at least one of the control position, which is the position of the drive source, and the output shaft position, based on predetermined conditions, and determines the amount of backlash based on the acquired control position and output shaft position. A tripod head device characterized by the following features.
2. A drive control position detection means for detecting the control position of the drive source The tripod head device according to claim 1, characterized by being equipped with the following features.
3. The aforementioned drive source is a stepper motor, The control means uses the number of pulses of the stepping motor as the control position of the drive source. The tripod head device according to feature 1.
4. The control means is The amount of backlash is calculated based on the first output shaft position at the time the drive source is driven to a predetermined position in the first direction. The tripod head device according to feature 1.
5. The control means is The amount of backlash is calculated based on the difference between the second output shaft position and the first output shaft position when the drive source is driven to the predetermined position in a second direction opposite to the first direction. The tripod head device according to feature 4.
6. The control means is Before driving the drive source in the first direction, it is driven in a second direction opposite to the first direction by an amount of movement that eliminates the amount of backlash. The tripod head device according to claim 4.
7. The control means is The first control position of the drive source at the start of driving when the drive source, which is being driven in a first direction, starts driving in a second direction opposite to the first direction, is obtained. The second control position of the drive source is obtained after the start of the drive and at the point when the output shaft position changes. The difference between the first control position and the second control position is calculated as the amount of backlash. The tripod head device according to feature 1.
8. The control means is The first control position of the drive source is obtained when the drive source, which is being driven in a first direction, starts to be driven in a second direction opposite to the first direction, and there is no longer any change in the output shaft position. The second control position of the drive source is obtained at the point when the change in the output shaft position resumes. The difference between the first control position and the second control position is calculated as the amount of backlash. The tripod head device according to feature 1.
9. The pan / tilt head device according to claim 1, wherein the output axis position detection means is an absolute value encoder.
10. A drive source that outputs driving force, A reduction mechanism for reducing the driving force of the aforementioned drive source, An output shaft connected to the reduction mechanism to which the reduced driving force is transmitted and which changes the shooting direction of the imaging means, An output shaft position detection means for detecting the output shaft position, which is the position of the output shaft, Control means for controlling the drive source, A control method for a pan / tilt head device that changes the shooting direction of an imaging means for photographing a subject, comprising: Based on predetermined conditions, at least one of the control position, which is the position of the drive source, and the output shaft position is obtained, and the amount of backlash is determined based on the obtained control position and output shaft position. A method for controlling a tripod head device, characterized by the features described above.
11. A program for causing a computer to function as a control means for the pan / tilt head device described in any one of claims 1 to 9.
Citation Information
Patent Citations
Automatic compensating device for backlash amount
JP1982196313A
Method of measuring quantity of backlash in industrial robot
JP1987166980A
JP1988170707U
Servo circuit for universal head
JP1997247504A
Motor-driven power steering device and backlash amount measuring method
JP2002337709A