The photoelectric servo control system based on PC controllers is mainly used to control the speed and position of the load. This paper analyzed the mathematical modeling and the system identification of the servo system. In the aspect of the control algorithm, the IP regulator, the fuzzy PID, the Active Disturbance Rejection Control (ADRC) and the adaptive algorithms were compared and analyzed. The PI-P control algorithm was proposed in this paper, which not only has the advantages of the PI regulator that can be quickly saturated, but also overcomes the shortcomings of the IP regulator. The control system has a good starting performance and the anti-load ability in a wide range. Experimental results show that the system has good performance under the guarantee of the PI-P control algorithm.
The endoscopic system is widely used in medical and industrial areas, but how to realize the high-precision three-dimensional measurement in the limited space scale still faces many challenges. A method based on the four-step phase-shifting structured light illumination is proposed in this paper for endoscopic 3D measurements. Structured light of which the adjacent phase shift is 90 degrees is generated by the different parts of the time-sharing lighting stripe grating of the optical fiber bundle; CMOS camera is used to collect four structured light images with the phase shift. Finally, the method of four-step phase-shifting is used to demodulate 3D information from the images, and a relative measurement accuracy of 95% within the range of 15-200mm can be obtained. The endoscope with a field of view of 90 degrees, a image resolution of 1280 * 800 and 3D depth calculation time of 0.2 seconds has advantages of simple structure, large field of view, high accuracy and good real-time measurement.