Adaptive positioning control method for filter component switching
By integrating a control circuit board and Hall effect switch into the filter assembly, the rotation adjustment parameters are detected and calculated in real time, solving the problem of inaccurate positioning of the filter assembly under high and low temperature environments and changes in installation preload, thus achieving precise positioning and efficient switching of the filter.
Patent Information
- Application Number
- CN202311671790.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-12-07
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2043-12-07
AI Technical Summary
In the prior art, there is a problem of inaccurate positioning of the filter assembly when the high and low temperature environment changes or the installation preload is different, especially the inaccurate positioning of the filter caused by the change of the rotation speed of the filter disc.
An adaptive positioning control method is adopted. By integrating a control circuit board into the filter assembly, Hall effect switches are used to detect the position of the filter. Combined with PWM signal isolation and power drive circuits, the command position and the current position of the filter are compared in real time, and the counterclockwise and clockwise rotation adjustment parameters are calculated to ensure the precise positioning of the filter disc.
It enables precise positioning of the filter under high and low temperature environments and varying installation preload, improving positioning accuracy and switching efficiency, simplifying operation steps, and enhancing system reliability.
Smart Images

Figure CN117784599B_ABST
Abstract
Description
Technical Field
[0001] This invention belongs to the field of optoelectronic control technology and relates to an adaptive positioning control method for switching filter components. Background Technology
[0002] Filter switching has a wide range of applications in optoelectronic imaging, such as spectral imaging and optical measurement. For photography and image processing, switching filter components under different environments can adjust the color balance and saturation of the image, correct color deviations, and provide better visual effects and color accuracy. In experimental research, filter switching can also filter out light of specific wavelengths, reduce the influence of stray light, and better meet the needs of fields such as spectroscopy and biomedical research for analyzing specific wavelengths.
[0003] In 2016, Chinese invention patent ZL201310214845.6 was granted a switching and positioning control method for a filter assembly. This method uses a coarse-fine combination approach to achieve accurate positioning and switching of multiple filters using a single position detection device, and also uses a time-delay stop method to achieve precise positioning of the filter, reducing the debugging difficulty of the filter assembly and improving the positioning accuracy of the filter assembly.
[0004] However, achieving precise filter positioning using a time-delay stop method requires setting an appropriate predetermined offset time. In practice, the following problems have been observed: when there are changes in high or low temperature environments or different pre-tightening forces during filter assembly installation, the rotation speed of the filter disc will change. Consequently, within the predetermined offset time, the change in the rotation angle of the filter disc will not match expectations, ultimately leading to inaccurate filter positioning. Summary of the Invention
[0005] (I) Purpose of the Invention
[0006] The purpose of this invention is to provide an adaptive positioning control method for switching filter components, which aims to solve the problem of inaccurate positioning in the existing technology when switching multiple filters under high and low temperature environments and when the installation preload is different.
[0007] (II) Technical Solution
[0008] To address the aforementioned technical problems, this invention provides an adaptive positioning control method for switching filter components, wherein n filters are arranged on the filter disc of the filter component, and each filter is denoted as F. iThe filter assembly also includes a control circuit board, which controls the filter to switch to the optical path according to the switching command. The control circuit board integrates a controller, a feedback signal isolation circuit, a PWM signal isolation circuit, and a power drive circuit. When the controller receives the switching command, it generates a control signal, which drives the motor to rotate through the PWM signal isolation circuit and the power drive circuit. At the same time, it receives the pulse signal from the Hall switch device from the feedback signal isolation circuit, compares the command position of the filter with the current position of the filter in real time, and determines whether the motor should stop moving, thus achieving precise positioning of the filter disc. The feedback signal isolation circuit realizes the isolation and shaping of the pulse signal collected by the Hall switch device. The PWM signal isolation circuit isolates and amplifies the strong and weak current of the PWM signal output by the controller. The power drive circuit amplifies the PWM control signal to drive the motor. The controller has a memory and a switching positioning control module. The memory stores the switching positioning control parameters, including the counterclockwise filter positioning adjustment parameter k. p [i] and clockwise filter positioning adjustment parameter k n [i] is used to calculate the forward movement time of the filter disc when switching the target filter to achieve precise positioning. The positioning control method includes three parts: memory parameter initialization, position identification and parameter calculation, and precise positioning and switching of the filter in the control circuit board. These are used to complete the rotation time interval control of the filter disc to achieve precise switching of the filter.
[0009] The filter assembly includes a filter disc 1, a transmission component 2, a motor 3, a position detection device (Hall switch device 4), and a control circuit board 5. The filter disc 1 includes a disk 1a and a filter 1b arranged on the disk 1a, and a position feedback device (magnet 1c). The disk 1a is a thin circular disk with a worm gear groove on its cylindrical surface. The transmission component 2 is a worm, one end of which is fixedly connected to the shaft of the motor 3 and meshes with the worm gear groove of the filter disc 1. When the motor 3 rotates, it carries the filter disc 1 to rotate around its rotation axis 1d. The Hall switch device 4 faces the filter disc 1, and the distance from its sensing center to the rotation axis of the filter disc 1 is equal to the distance from the magnet 1c to the rotation axis of the filter disc 1. The control circuit board 5 receives a switching command and, based on the feedback signal detected by the Hall switch device 4, sends a control command to the motor 3 to switch the filter 1b to the optical path.
[0010] Among them, the filter assembly has n filters F i and n magnets M i All are evenly distributed on disk 1a at 360° / n intervals; Filter F i With magnet M i The phase distribution is alternating, meaning that magnet M1 is distributed between filters F1 and F2, and magnet M2 is distributed between filters F2 and F3. n Magnets are distributed in the F of the filter nThe middle of F1; magnet M0, number zero, is located at magnet M. n Between and adjacent to magnet M1, zero magnet M0 and magnet M i Distributed on the same concentric circle; n filters F i The dimensions of the objects are consistent, and they are evenly distributed on a concentric circle centered on the rotation axis of disk 1a.
[0011] All of the magnets mentioned herein have the same external dimensions, and magnet M i The magnets are evenly distributed on a concentric circle centered on the rotation axis of disk 1a. When the filter disk rotates, the s pole of the corresponding magnet is always aligned with the Hall switch device 4; each magnet M i The given feedback signal represents its corresponding filter F i The location information, the number i of the magnet corresponds to the number i of the filter. When the Hall switch device detects a signal of magnet M1, then the filter in the optical path is F1.
[0012] The transmission method of the filter disc is either worm gear transmission, gear transmission, or direct drive transmission.
[0013] The memory parameter initialization includes defining the following parameter: k p [i] represents the positioning adjustment parameter for the i-th filter when the filter disc rotates counterclockwise, k n [i] represents the positioning adjustment parameter for the i-th filter when the filter disc rotates clockwise, t pd [i] represents the time of the i-th falling edge when the filter rotates counterclockwise, t pu [i] represents the time of the i-th rising edge when the filter rotates counterclockwise, and the corresponding t. nd [i] represents the time of the i-th falling edge when the filter rotates clockwise, t nu [i] represents the time of the i-th rising edge when the filter rotates clockwise, m d m is the number of falling edges. u t represents the number of rising edges. s For a rotary timer, t x For delayed stop timer;
[0014] k p [i] and k n [i] The results were obtained through experimental debugging and stored in memory for real-time use by the switching positioning control program.
[0015] When a counterclockwise rotation command is received, the positioning control method includes two processes: filter disc position identification and parameter calculation, and filter precise positioning and switching.
[0016] The steps for identifying the location and calculating the parameters of the filter disc are as follows:
[0017] S1: Input the filter disc rotation command, which drives the filter disc to rotate via a motor. The counter-clockwise rotation command means the filter rotates according to F1→F2→F3→F4, ..., F... n The instructions to enter the optical path in the order of →F1→F2→…
[0018] S2: Determine whether a falling edge of the position detection device's feedback signal has been detected. If false, continue detection; if true, when the first falling edge is detected, t... s The rotary timer starts counting, simultaneously initiating both rising and falling edge counting. At this moment, m... d =1;
[0019] S3: Determine whether the feedback signal is a rising edge or a falling edge. If it is a falling edge, then the number of falling edges is m. d Increment by 1, and record the time t. s The value is denoted as time value t. pd [i], the value of i is related to m d The sequence numbers are the same; if a rising edge is detected, refer to the falling edge handling method, with the number of rising edges m. u Add 1 and record the time t. s The value is denoted as time value t. pu [i];
[0020] S4: Determine if the number of falling edges exceeds the total number of filters plus 1, i.e., determine m. d Is it greater than n+1? If it is false, return to step S3; if it is true, continue to step S5.
[0021] S5: Rotating Time Timer t s Stop timing and send a command to the motor to stop the rotation of the filter disc;
[0022] S6: Based on the data recorded in steps S1 to S5, perform the following data processing;
[0023] Calculate the falling edge interval of all two adjacent pulses and compare them to obtain the minimum time t. dmin The formula used is:
[0024] t dmin =min(t) pd [1]-t pd [0],t pd [2]-t pd [1],…,t pd [i]-t pd [i-1],…,t pd [n+1]-t pd [n])
[0025] Among them, t d [i-1]=t pd [i]-t pd [i-1] represents the time interval between adjacent falling edges;
[0026] Mark the falling edge at the minimum moment position as the starting position P1, and mark the corresponding filter as F[1]; mark all filters according to the position of P1, clarify the filter number currently in the optical path, and complete the filter disk position identification; record the interval time from the falling edge to the rising edge of the pulse corresponding to P1 (i.e., the low-level pulse width time) as T[1], and calculate all low-level pulse width times T[i] according to this rule, where T[i] = t pu [i]-t pd [i]; Starting from filter F[1], the low-level pulse width time of each magnet corresponding to the position is marked as: T[1], T[2], ..., T[n];
[0027] Adjust parameter k by rotating it counterclockwise from the preset settings. p [i] and clockwise rotation adjustment parameter k n [i], calculate the rotation time required for the target filter to reach the specified center position from the corresponding falling edge: the counterclockwise adaptive delay stop time TP[i] and the clockwise adaptive delay stop time TN[i], calculated using the following formula:
[0028] TP[i] = k p [i]T[i]
[0029] TN[i] = k n [i]T[i]
[0030] Where TP[i] and TN[i] are the time required for the magnet corresponding to the i-th filter to rotate from the initial falling edge to the point where the center of the filter coincides with the optical axis of the optical system when rotating counterclockwise and clockwise, respectively; and T[i] is the low-level pulse width time corresponding to the i-th filter.
[0031] Switching to filter F[x], the precise positioning and switching steps for the filter include:
[0032] S11: Input the target filter number x to switch. Based on the starting position marked on the filter disc and the current rotation direction of the filter disc, obtain the filter number i in the current optical path.
[0033] S12: Select a rotation direction instruction for the optical filter disc, by calculating the difference between the target optical filter disc number and the current optical filter number, using the formula: 0<x-i≤n / 2 or x-i≤-n / 2, where n is the total number of optical filters mounted on the optical filter disc. If the result is true, send a counterclockwise rotation instruction for the optical filter disc to the motor; if the result is false, send a clockwise rotation instruction for the optical filter disc to the motor;
[0034] S13: Start the motor to drive the optical filter disc to rotate, adaptively calculate the delay stop time TP[i] or TN[i] according to the input parameters, start timing from the moment the target optical filter F(x) enters the optical path, end the timing after the above delay stop time, stop the motor, and complete the optical filter switching.
[0035] Wherein, step S13 includes the following processes:
[0036] When it is judged in step S12 that the optical filter disc rotates counterclockwise, the current optical filter number is incremented by 1 every time a falling edge signal is detected, until the current optical filter number is equal to the input target optical filter number. When the falling edge time corresponding to the target number optical filter is reached, the delay stop timer t x starts to run, the motor stops working after the optical filter disc advances for the duration TP[i], the rotation timer stops and is reset to zero, where i is the target optical filter number; at the same time, it is necessary to ensure that the current number value does not exceed the total number of mounted optical filters every time the number changes. If the number value exceeds the total number of optical filters, the optical filter number cycle is started, that is, the cyclic increment of the numbers is restarted from 1;
[0037] When it is judged in step S12 that the optical filter disc rotates clockwise, the current optical filter number is decremented by 1 every time a falling edge signal is detected, until the current optical filter number is equal to the input target optical filter number. When the falling edge time corresponding to the target number optical filter is reached, the delay stop timer t x starts to run, the motor stops working after the optical filter disc advances for the duration TN[i], the rotation timer stops and is reset to zero; at the same time, it is necessary to ensure that the current number value is greater than zero every time the number changes. If the number value is less than zero, the optical filter number cycle is started, that is, the cyclic decrement of the numbers is restarted from n.
[0038] Wherein, in step S13, taking clockwise rotation as an example, the corresponding rotation adjustment parameter k n [i] is acquired as follows:
[0039] (1) The motor drives the optical filter disc to rotate clockwise, and an oscilloscope is used to measure the feedback signal of the detection device at the same time;
[0040] (2) During the rotation, record the time corresponding to each falling edge and rising edge. In this embodiment, the total number of filters is 4 and the corresponding number of magnets is 5. Therefore, when the filter completes one rotation, there will be 5 falling edge pulses. In order to ensure that all filters enter the optical path during this process, select 6 falling edge pulses and then assume that the filter has completed one rotation.
[0041] (3) During the rotation process, when the center point of the i-th filter coincides with the optical axis of the system detection, the time interval from the falling edge of the corresponding low pulse to that moment is recorded and denoted as: TN[i];
[0042] (4) Start the controller and continue to execute the rotation command in the rotation direction in (1) until all the filters on the component have completed the measurement of the offset time when the center point position coincides with the system detection optical axis;
[0043] (5) Calculate the clockwise rotation adjustment parameter k n [i], where k n [i] = TN[i] / T[i], and write it into the controller's memory.
[0044] Rotate counterclockwise to adjust parameter k p [i] is obtained in the same way as above, where k p [i] = TP[i] / T[i].
[0045] The two processes included in the positioning and switching control method described above can be further simplified in practical applications depending on the specific circumstances. For example, when the interval between two switching commands is short and the usage environment does not change significantly, the step of identifying the filter disc position and calculating parameters can be skipped, and the rotation adjustment parameters input during the first switching can be used directly to perform precise filter positioning and switching.
[0046] (III) Beneficial Effects
[0047] The adaptive positioning control method for switching filter components provided by the above technical solution has the following beneficial effects:
[0048] (1) Through the process of filter disc position identification and parameter calculation, this invention calculates the corresponding rotation adjustment parameters required for different rotation directions when accurately positioning each filter. This avoids the problem of inaccurate filter positioning caused by different magnetism of the magnet, high and low temperature changes, changes in friction coefficient, and different installation pre-tightening force. It ensures that when each filter enters the optical path, its center can be kept on the same straight line as the detection optical axis, which can better meet the needs of precise and rapid filter switching in engineering applications.
[0049] (2) Compared with the prior art, the filter switching required by the present invention only has two parameters: clockwise rotation adjustment parameter and counterclockwise rotation adjustment parameter, so the switching command control process is simple, efficient and more reliable.
[0050] (3) The two steps in the positioning switching control included in the method of the present invention can be flexibly adjusted and used according to the specific situation. For example, when there is no significant change in the external environment and the interval between the current use and the last use is short, the step of filtering the optical disc position identification and parameter calculation can be skipped, and the rotation adjustment parameters used in the last switching can be directly used for accurate positioning in this switching process, which effectively reduces the system running time and further simplifies the operation steps. Attached Figure Description
[0051] Figure 1 This is a schematic diagram of the composition of the filter assembly.
[0052] Figure 2 yes Figure 1 A schematic diagram of the composition of the medium filter optical disc.
[0053] Figure 3 yes Figure 1 Block diagram of the control principle of the control circuit board.
[0054] Figure 4 This is a flowchart of the switching positioning control method of the present invention.
[0055] Figure 5 yes Figure 4 Workflow diagram for positioning the optical disc in the middle filter.
[0056] Figure 6 yes Figure 4 Workflow diagram of adaptive switching of intermediate filters.
[0057] Figure 7 yes Figure 1 The signal output diagram of the Hall switch device when the middle filter disc is rotated counterclockwise one revolution.
[0058] Figure 8 This is a diagram showing the signal output of the Hall effect switch when the magnet moves to different positions. Detailed Implementation
[0059] To make the objectives, contents, and advantages of the present invention clearer, the specific embodiments of the present invention will be described in further detail below with reference to the accompanying drawings and examples.
[0060] like Figure 1As shown, the filter assembly involved in this embodiment consists of a filter disc 1, a transmission component 2, a motor 3, a position detection device (Hall switch device 4), and a control circuit 5. The filter disc 1 includes a disc 1a, four filters 1b, and five position feedback devices (magnets 1c). The disc 1a is a thin circular disc with a worm gear groove on its cylindrical surface. The transmission component 2 is a worm, one end of which is fixedly connected to the shaft of the motor 3 and meshes with the worm gear groove of the filter disc 1. When the motor 3 rotates, it carries the filter disc 1 to rotate around its rotation axis 1d. The Hall switch device 4 faces the filter disc 1, and the distance from its sensing center to the rotation axis of the filter disc 1 is equal to the distance from the magnet 1c to the rotation axis of the filter disc 1. The control circuit board 5 receives the switching command and sends a control command to the motor 3 according to the feedback signal detected by the Hall switch device 4, so that the filters 1b are switched to the optical path.
[0061] In this embodiment, the filter disk of the filter assembly is a filter disk with four filters, see [link to documentation]. Figure 2 The number of filters on the aforementioned filter disc can be any number n, where n≥2, and there are n+1 position feedback devices. Without loss of generality, the implementation method of the filter disc is described in detail below:
[0062] n filters F i and n magnets M i The filters are evenly distributed on disk 1a at intervals of 360° / n, i = 1, 2, ..., n and n ≥ 2; Filter F i With magnet M i The phase distribution is alternating, meaning that magnet M1 is distributed between filters F1 and F2, and magnet M2 is distributed between filters F2 and F3. n Magnets are distributed in the F of the filter n Between F1 and F2. The other magnet, M0 (magnet number zero), is located between magnets M and F2. n Between and adjacent to magnet M1, zero magnet M0 and magnet M i The n filters F are distributed on the same concentric circle. i All magnets have the same external dimensions and are evenly distributed on a concentric circle centered on the rotation axis of disk 1a. This ensures that when the filter disk rotates and switches, all filters entering the optical path are aligned with the center of imaging device 5. All magnets have the same external dimensions, and magnet M... i The magnets are evenly distributed on a concentric circle centered on the rotation axis of disk 1a, ensuring that the s pole of the corresponding magnet is always aligned with the Hall switch device 4 when the filter disk rotates. Each magnet M... i The given feedback signals can all represent their corresponding filter F i The location information, the number i of the magnet corresponds to the number i of the filter. When the Hall switch device detects a signal of magnet M1, then the filter in the optical path is F1.
[0063] Magnet M0 and magnet M1 are placed close together, so that when the filter disc rotates counterclockwise, Hall switch 4 will face magnet M0 and magnet M1 in turn. Two consecutive pulses with the shortest interval will appear at the signal output terminal, which makes it easy to find the filter marked F1 in the filter disc.
[0064] In this embodiment, the transmission method of the filter disc is a worm gear transmission method. Of course, other forms of transmission methods can also be used, such as gear transmission method or direct drive transmission method.
[0065] Although this embodiment focuses on using a magnet and Hall effect switch to provide the position signal for the filter, other non-contact position detection devices can also be used to provide the position signal, such as photoelectric switches. It simply requires... Figure 1 The magnet 1c in the middle is replaced with a through hole, and the Hall switch device 4 is replaced with a photoelectric switch device.
[0066] The principle of the control circuit board 5 of the filter assembly is as follows: Figure 3 As shown, the control circuit board integrates a controller, a feedback signal isolation circuit, a PWM signal isolation circuit, and a power drive circuit. When the controller receives a switching command, it generates a control signal, which drives the motor to rotate through the PWM signal isolation circuit and the power drive circuit. Simultaneously, it receives the pulse signal from the Hall switch device from the feedback signal isolation circuit, compares the commanded position of the filter with the current position of the filter in real time, and determines whether the motor should stop moving, thus achieving precise positioning of the filter disc. The feedback signal isolation circuit isolates and shapes the pulse signal acquired from the Hall switch device. The PWM signal isolation circuit isolates and amplifies the strong and weak currents of the PWM signal output by the controller. The power drive circuit amplifies the PWM control signal to drive the motor.
[0067] The controller is the core of the switching positioning control method of this invention. The controller contains a memory and a switching positioning control module. The memory stores switching positioning control parameters, including the counter-clockwise filter positioning adjustment parameter k. p [i] and clockwise filter positioning adjustment parameter k n [i] is used to calculate the forward movement time of the filter disc when switching filters, so as to achieve precise positioning.
[0068] The following specific examples illustrate the implementation of the present invention.
[0069] In this embodiment, n=4 is chosen, meaning the filter disc is equipped with 4 filters, where k p [i] represents the positioning adjustment parameter for the i-th filter when the filter disc rotates counterclockwise, k n [i] represents the positioning adjustment parameter for the i-th filter when the filter disc rotates clockwise, t pd[i] represents the time of the i-th falling edge when the filter rotates counterclockwise, t pu [i] represents the time of the i-th rising edge when the filter rotates counterclockwise, and the corresponding t. nd [i] represents the time of the i-th falling edge when the filter rotates clockwise, t nu [i] represents the time of the i-th rising edge when the filter rotates clockwise, m d m is the number of falling edges. u t represents the number of rising edges. s For a rotary timer, t x This is a timer for delaying the stop.
[0070] Among these control parameters, k p [i] and k n [i] The parameters are obtained through experimental debugging and stored in the memory for real-time calling by the switching positioning control program. Other parameters are all reset to zero during the controller module initialization process.
[0071] refer to Figure 4 As shown, this embodiment implements a control method for adaptive switching of filter components through a switching positioning control module, which mainly includes three parts: memory parameter initialization, filter disc position identification and parameter calculation, and precise filter positioning and switching.
[0072] Register parameter initialization includes the following:
[0073] Based on the filter assembly installation method, each filter is numbered individually, and then the parameter k is retrieved from memory. p [i] and k n [i], where i = 0, 1, 2, 3, ..., n is the filter number, n is the total number of filters installed in the filter assembly, and finally let the parameter t pd [i] = 0, t pu [i] = 0, t nd [i] = 0, t nu [i] = 0, m d =0,m u =0,t s =t x =0;
[0074] refer to Figure 5 As shown, taking the counterclockwise rotation command as an example, the filter positioning method includes two processes: position identification and parameter calculation, and precise positioning and switching of the filter. The basic process is as follows.
[0075] The steps for identifying the location and calculating the parameters of the filter disc are as follows:
[0076] S1: Input the filter disc rotation command, which drives the filter disc to rotate via a motor. The counterclockwise rotation command means that the filter enters the optical path in the order of F1→F2→F3→F4→F1→F2→… (starting from any starting position in the cycle).
[0077] S2: Determine if a falling edge of the position detection device's feedback signal has been detected. If false, continue detection; if true, upon first detection of a falling edge, t s The rotary timer starts counting, simultaneously initiating both rising and falling edge counting. At this moment, m... d =1;
[0078] S3: Determine whether the feedback signal is a rising edge or a falling edge. If it is a falling edge, then the number of falling edges is m. d Increment by 1, and record the time t. s The value is denoted as time value t. pd [i], the value of i is related to m d The sequence numbers are the same; if a rising edge is detected, refer to the falling edge handling method, with the number of rising edges m. u Add 1 and record the time t. s The value is denoted as time value t. pu [i];
[0079] S4: Determine if the number of falling edges exceeds the total number of filters plus 1, i.e., determine m. d Is it greater than n+1? If it is false, return to step S3; if it is true, continue to step S5.
[0080] S5: Rotating Time Timer t s Stop timing and send a command to the motor to stop the rotation of the filter disc;
[0081] S6: Based on the data recorded in steps S1 to S5, perform the following data processing;
[0082] Calculate the falling edge interval of all two adjacent pulses and compare them to obtain the minimum time t. dmin The formula used is:
[0083] t dmin =min(t) pd [1]-t pd [0],t pd [2]-t pd [1],…,t pd [i]-t pd [i-1],…,t pd [n+1]-t pd [n])
[0084] Among them, t d [i-1]=tpd [i]-t pd [i-1] represents the time interval between adjacent falling edges;
[0085] refer to Figure 7 As shown, the falling edge at the minimum moment is marked as the starting position P1, and the corresponding filter is marked as F[1]. According to the position of P1, all filters are marked to clarify the filter number currently in the optical path and complete the identification of the filter disk position. The time interval between the falling edge and the rising edge of the pulse corresponding to P1 (i.e., the low-level pulse width time) is denoted as T[1], and all low-level pulse width times T[i] are calculated according to this rule, where T[i] = t pu [i]-t pd [i]; Starting from filter F[1], the low-level pulse width time of each magnet corresponding to the position is marked as: T[1], T[2], ..., T[n];
[0086] See Figure 8 The parameter k can be adjusted by rotating it counterclockwise in the preset settings. p [i] and clockwise rotation adjustment parameter k n [i], calculate the rotation time required for the target filter to reach the specified center position from the corresponding falling edge: counterclockwise adaptive delay stop time TP[i] and clockwise adaptive delay stop time TN[i], using the following formula:
[0087] TP[i] = k p [i]T[i]
[0088] TN[i] = k n [i]T[i]
[0089] Where TP[i] and TN[i] are the time required for the magnet corresponding to the i-th filter to rotate from the initial falling edge to the point where the center of the filter coincides with the optical axis of the optical system when rotating counterclockwise and clockwise, respectively, and T[i] is the low-level pulse width time corresponding to the i-th filter;
[0090] refer to Figure 6 As shown in the embodiment, taking the switching to filter number F[x] as an example, the filter precise positioning and switching steps specifically include:
[0091] S1: Input the target filter number x to switch. Based on the starting position marked on the filter disc and the current rotation direction of the filter disc, obtain the filter number i in the current optical path.
[0092] S2: Select a rotation direction instruction for the filter disc, by calculating the difference between the target filter disc number and the current filter number, the formula adopted is: 0<x-i≤n / 2 or x-i≤-n / 2, where n is the total number of filters mounted on the filter disc; if the result is true, send a counterclockwise rotation instruction for the filter disc to the motor; if the result is false, send a clockwise rotation instruction for the filter disc to the motor;
[0093] S3: Start the motor to drive the filter disc to rotate to the target position and then stop working;
[0094] When it is determined in step S2 that the filter disc rotates counterclockwise, the current filter number is incremented by 1 every time a falling edge signal is detected, until the current filter number is equal to the input target filter number. When reaching the falling edge time moment corresponding to the filter of the target number, the delay stop timer t x starts to run, after the filter disc forward rotation duration TP[i] = k p [i]T[i] (where i is the target filter number) elapses, the motor stops working, the rotation timer stops and is reset to zero, where i is the target filter number; at the same time, every time the number changes, it is necessary to ensure that the current number value does not exceed the total number of mounted filters. If the number value exceeds the total number of filters, the filter number cycle starts, that is, the cyclic increment of the number starts again from 1;
[0095] When it is determined in step S2 that the filter disc rotates clockwise, the current filter number is decremented by 1 every time a falling edge signal is detected, until the current filter number is equal to the input target filter number. When reaching the falling edge time moment corresponding to the filter of the target number, the delay stop timer t x starts to run, after the filter disc forward rotation duration TN[i] = k n [i]T[i] (where i is the target filter number) elapses, the motor stops working, the rotation timer stops and is reset to zero; at the same time, every time the number changes, it is necessary to ensure that the current number value is greater than zero. If the number value is less than zero, the filter number cycle starts, that is, the cyclic decrement of the number starts again from n;
[0096] In step S3, the process of obtaining the clockwise rotation adjustment parameter k n [i] is as follows:
[0097] (1) The motor drives the filter disc to rotate clockwise, and an oscilloscope is used to measure the feedback signal of the detection device at the same time;
[0098] (2) During the rotation process, record the corresponding moment of each falling edge and rising edge. In this embodiment, the total number of filters is 4, and the corresponding number of magnetic steels is 5. Therefore, when the filter disc completes one full rotation, 5 falling edge pulses will appear. To ensure that all filters pass through the optical path during this process, it is selected to collect 6 falling edge pulses and then default that one full rotation of the filter disc is completed;
[0099] (3) During the rotation process, when the center point of the i-th filter coincides with the optical axis of the system detection, the time interval from the falling edge of the corresponding low pulse to that moment is recorded and denoted as: TN[i];
[0100] (4) Start the controller and continue to execute the rotation command in the rotation direction in (1) until all the filters on the component have completed the measurement of the offset time when the center point position coincides with the system detection optical axis;
[0101] (5) Calculate the direction adjustment parameter k n [i], where k n [i] = TN[i] / T[i], which will be written into the controller's memory.
[0102] Adjustment parameter k for counterclockwise rotation p [i] is obtained in the same way as above, where k p [i] = TP[i] / T[i].
[0103] The two processes included in the positioning and switching control method described above can be further simplified in practical applications depending on the specific circumstances. For example, when the interval between two switching commands is short and the usage environment does not change significantly, the step of identifying the filter disc position and calculating parameters can be skipped, and the rotation adjustment parameters input during the first switching can be used to directly perform precise filter positioning and switching.
[0104] The above description is merely an example of adaptive positioning control for switching filter components according to the present invention, and is not intended to limit the switching direction, parameter calculation, etc. in the present invention. In specific use, the selection of rotation direction, rotation time, etc. should refer to the current demand command and be specifically selected based on the above scheme.
[0105] The basic principle for obtaining the clockwise and counterclockwise rotation adjustment parameters involved in the aforementioned basic examples and specific embodiments of the present invention is based on Figure 1 In the original hardware system, the actual positional distribution of the magnets and filters on the filter disc is absolutely fixed. Furthermore, in the same switching application, the acquired rotation adjustment parameters are consistent with the actual rotation speed during the switching process. Each time it is used, these parameters are calculated in real-time based on the current operating environment and hardware conditions. Therefore, even when facing high and low temperature operating environments, varying magnet preload during installation, and other environmental interference factors, the accuracy of the rotation adjustment parameters can still be guaranteed, achieving true adaptive positioning control for filter component switching.
[0106] The above description is only a preferred embodiment of the present invention. It should be noted that for those skilled in the art, several improvements and modifications can be made without departing from the technical principles of the present invention, and these improvements and modifications should also be considered within the scope of protection of the present invention.
Claims
1. An adaptive positioning control method for switching filter components, characterized in that, The filter assembly is arranged on the filter disc. n There are 10 filters, each denoted as 1. F i , i =1, 2, ..., n and n ≥2; The filter assembly also includes a control circuit board, which controls the filter to switch to the optical path according to the switching command; the control circuit board integrates a controller, a feedback signal isolation circuit, a PWM signal isolation circuit, and a power drive circuit; when the controller receives the switching command, it generates a control signal, which drives the motor to rotate through the PWM signal isolation circuit and the power drive circuit. At the same time, it receives the pulse signal of the Hall switch device from the feedback signal isolation circuit, compares the command position of the filter with the current position of the filter in real time, and determines whether the motor should stop moving, so as to achieve precise positioning of the filter disc; the feedback signal isolation circuit realizes the isolation and shaping of the pulse signal of the Hall switch device; the PWM signal isolation circuit isolates and amplifies the strong and weak current of the PWM signal output by the controller; the power drive circuit amplifies the PWM control signal to drive the motor; the controller has a memory and a switching positioning control module. The memory stores the switching positioning control parameters, including the counterclockwise filter positioning adjustment parameters. k p [ i ] and clockwise filter positioning adjustment parameters k n [ i The positioning control method is used to calculate the forward movement time of the filter disc when switching filters, so as to achieve precise positioning. The positioning control method includes three parts: register parameter initialization in the control circuit board, position identification and parameter calculation, and precise positioning and switching of the filter disc. These three parts are used to complete the rotation time interval control of the filter disc, so as to achieve precise switching of the filter disc. The filter assembly includes a filter disc (1), a transmission component (2), a motor (3), a position detection device, namely a Hall switch device (4), and a control circuit board (5). The filter disc (1) includes a disc (1a) and a filter (1b) arranged on the disc (1a), and a position feedback device, namely a magnet (1c). The disc (1a) is a thin circular disc with a worm gear groove on its cylindrical surface. The transmission component (2) is a worm, one end of which is fixedly connected to the shaft of the motor (3) and meshes with the worm gear groove of the filter disc (1). When the motor (3) rotates, it carries the filter disc (1) to rotate around its rotation axis (1d). The Hall switch device (4) is facing the filter disc (1), and the distance from its sensing center to the rotation axis of the filter disc (1) is equal to the distance from the magnet (1c) to the rotation axis of the filter disc (1). The control circuit board (5) receives the switching command and sends a control command to the motor (3) according to the feedback signal detected by the Hall switch device (4) to switch the filter (1b) to the optical path. In the filter assembly n A filter F i and n magnets M i All at 360° / n The spacing is evenly distributed on the disk (1a); the filter F i With magnets M i It is a phased distribution, that is M 1. Magnets are distributed in the filter. F 1. F In the middle of 2 M 2. Magnets are distributed on the filter. F 2. F The middle of 3 M n Magnets are distributed in the filter. F n , F The middle of 1; zero magnet M 0 is located in the magnet M n With magnets M 1 between and with magnet M 1. Neighbor, No. 0 magnet M 0 and magnet M i They are distributed on the same concentric circle; n A filter F i The dimensions of the objects are consistent and they are evenly distributed on concentric circles centered on the rotation axis of the disk (1a). All the magnets described have the same external dimensions. M i The magnets are evenly distributed on a concentric circle centered on the rotation axis of the disk (1a). When the filter disk rotates, the s pole of the corresponding magnet is always aligned with the Hall switch device (4); each magnet M i The given feedback signal represents its corresponding filter. F i Location information, magnet number i With the filter number i Correspondingly, when the Hall switch device detects that it is M If the signal is from a magnet, then the filter in the optical path is... F 1; The transmission method of the filter disc is either worm gear transmission, gear transmission, or direct drive transmission. The memory parameter initialization includes defining the following parameters: k p [ i [When the filter disc rotates counterclockwise] i Filter positioning and adjustment parameters k n [ i [When the filter disc rotates clockwise] i Filter positioning and adjustment parameters t pd [ i [When the filter disc rotates counterclockwise] i The time at which the falling edge occurs t pu [ i [When the filter disc rotates counterclockwise] i The time at which each rising edge occurs, and the corresponding t nd [ i [When the filter disc rotates clockwise] i The time at which the falling edge occurs t nu [ i [i] represents the time of the i-th rising edge when the filter disc rotates clockwise. m d Number of falling edges m u The number of rising edges. t s For rotary timers, t x For delayed stop timer; k p [ i ]and k n [ i The results were obtained through experimental debugging and stored in memory for real-time recall by the switching positioning control program; When a counterclockwise rotation command is received, the positioning control method includes two processes: filter disc position identification and parameter calculation, and precise filter positioning and switching. The steps for filter disc position identification and parameter calculation are as follows: S1: input the rotating instruction of the filter disc, drive the filter disc to rotate through the motor, wherein the counterclockwise rotating instruction refers to the instruction that the filter enters the light path in the order of F1→F2→F3→F4, …, F n →F1→F2→…; S2: Determine whether a falling edge of the position detection device's feedback signal has been detected. If false, continue detection; if true, upon first detection of a falling edge... t s The rotary timer starts counting, simultaneously initiating both rising and falling edge counting. m d =1; S3: Determine whether the feedback signal is a rising edge or a falling edge. If it is a falling edge, count the number of falling edges. m d Increment by 1 and record the time. t s The value is then labeled as the time value. t pd [ i ], i Value and m d The sequence numbers are the same; if a rising edge is detected, refer to the falling edge handling method, and the number of rising edges... m u Add 1 to record this moment. t s The value is then labeled as the time value. t pu [ i ]; S4: judge whether the number of falling edges exceeds the total number of filters plus 1, i.e. judge whether m d is greater than n+1, if false, return to step S3; if true, continue to execute step S5; S5: Rotating Time Timer t s Stop timing and send a command to the motor to stop the rotation of the filter disc; S6: Based on the data recorded in steps S1 to S5, perform the following data processing; Calculate the falling edge interval of all two adjacent pulses and compare them to find the minimum time. t dmin The formula used is: t dmin =min( t pd [1]- t pd [0], t pd [2]- t pd [1],…, t pd [ i ]- t pd [ i -1],…, t pd [ n +1]- t pd [ n ] ) in, t d [ i -1]= t pd [ i ]- t pd [ i -1] represents the time interval between adjacent falling edges; Mark the falling edge at the minimum moment as the starting position P1, and mark the corresponding filter as F[1]; mark all filters according to the position of P1, clarify the filter number currently in the optical path, and complete the filter disc position identification; record the time interval between the falling edge and the rising edge of the pulse corresponding to P1, that is: the low-level pulse width time is T[1], and calculate all low-level pulse width times T[1] according to this rule. i ], where T[ i ]= t pu [ i ]- t pd [ i Starting from filter F[1], the low-level pulse width time of each magnet corresponding to a position is sequentially marked as: T[1], T[2], ..., T[n]; Adjust the parameters by rotating counterclockwise from the preset settings. k p [ i Adjust parameters by clockwise rotation. k n [ i ], calculate the rotation time required for the target filter to reach the specified center position from the corresponding falling edge: counterclockwise adaptive delay stop time TP[ i ] and clockwise adaptive delay stop time TN[ i The calculation formula is as follows: TP[ i ]= k p [ i ] T[ i ] TN[ i ]= k n [ i ] T[ i ] Where TP[i] and TN[i] are the time required for the magnet corresponding to the i-th filter to rotate from the initial falling edge to the point where the center point of the filter coincides with the optical axis of the optical system when rotating counterclockwise and clockwise, respectively, and T[i] is the low-level pulse width time corresponding to the i-th filter; Switch to number F[ x The filter, wherein the precise positioning and switching steps of the filter include: S11: Enter the target filter number to switch. x Based on the starting position marked on the filter disc and the current rotation direction of the filter disc, the filter number i in the current optical path is obtained; S12: Select the filter disc rotation direction command, which is calculated by the difference between the target filter disc number and the current filter number, using the formula: 0 < xi ≤n / 2 or xi ≤-n / 2, where n is the total number of filters installed on the filter disc. If true, a counterclockwise rotation command is sent to the motor; if false, a clockwise rotation command is sent to the motor. S13: Start the motor, drive the filter disc to rotate, and adaptively calculate the delay stop time TP based on the input parameters. i ] or TN[ i ], in the target filter F[ x The timing begins when the light enters the optical path and ends after the aforementioned delay time. The motor then stops working, completing the filter switching.
2. The adaptive positioning control method for switching filter components as described in claim 1, characterized in that, Step S13 includes the following processes: When it is determined in step S12 that the filter disc is rotating counterclockwise, the current filter number is incremented by 1 each time a falling edge signal is detected, until the current filter number equals the input target filter number. When the falling edge time corresponding to the target filter number is reached, the delay stop timer starts, and the filter disc advance time TP[ i The motor then stopped working, where TP[ i ]= k p [ i ]T[ i The rotating timer stops and resets to zero. i Number the target filter; at the same time, each time the number changes, it is necessary to ensure that the current number value does not exceed the total number of filters installed. If the number value exceeds the total number of filters, the filter numbering cycle will start again, that is, starting from 1 and entering the numbering cycle again. When it is determined in step S12 that the filter disc is rotating clockwise, the current filter number is decremented by 1 each time a falling edge signal is detected until the current filter number equals the input target filter number; when the falling edge time corresponding to the target filter number is reached, the delay stop timer starts, and the filter disc advance time TN[ i The motor then stops working, where TN[ i ]= k n [ i ]T[ i The rotating timer stops and resets to zero. At the same time, it is necessary to ensure that the current number value is greater than zero each time the number changes. If the number value is less than zero, the filter numbering cycle begins again, that is, starting from n, the numbering cycle is decremented again.
3. The adaptive positioning control method for switching filter components as described in claim 2, characterized in that, In step S13, taking clockwise rotation as an example, the parameters are adjusted by clockwise rotation. k n [ i The acquisition process is as follows: (1) The motor drives the filter disc to rotate clockwise, and at the same time the oscilloscope is used to measure the feedback signal of the detection device; (2) During the rotation, record the time corresponding to each falling edge and rising edge. The total number of filters is 4, and the corresponding magnets are 5. When the filter completes one full rotation, 5 falling edge pulses appear. Select to collect 6 falling edge pulses and then the filter completes one full rotation by default. (3) During the rotation process, when the center point of the i-th filter coincides with the optical axis of the system's detection, record the time interval from the falling edge of the corresponding low pulse to that moment, and denote it as: TN[ i ]; (4) Start the controller and continue to execute the rotation command in the rotation direction in (1) until all filters on the component have completed the measurement of the offset time when the center point position coincides with the system detection optical axis; (5) Calculate the direction adjustment parameters k n [ i ]= TN[ i ] / T[ i ], calculate the value k n [ i Write it into the controller's memory; Adjust parameters by rotating counterclockwise k p [ i The acquisition method is the same as above, where k p [ i ]= TP[ i ] / T[ i ].
4. An application of an adaptive positioning control method for switching filter components based on claim 1 or 2 in the field of optoelectronic control technology.
Citation Information
Patent Citations
Switching positioning control method of filter assembly
CN103309739B
Switching positioning control method for optical filtering assembly
CN103309739A
LED projecting light fixture with additional light effects
CN108027123A
