CN103543735A - Distributed type low-speed high-precision device and method for controlling astronomical telescope - Google Patents
Distributed type low-speed high-precision device and method for controlling astronomical telescope Download PDFInfo
- Publication number
- CN103543735A CN103543735A CN201310526148.4A CN201310526148A CN103543735A CN 103543735 A CN103543735 A CN 103543735A CN 201310526148 A CN201310526148 A CN 201310526148A CN 103543735 A CN103543735 A CN 103543735A
- Authority
- CN
- China
- Prior art keywords
- speed
- state
- button
- telescope
- numerator
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title abstract description 20
- 238000004891 communication Methods 0.000 claims description 27
- 238000012360 testing method Methods 0.000 claims description 11
- 238000013459 approach Methods 0.000 claims description 10
- 230000007423 decrease Effects 0.000 claims description 8
- 230000000295 complement effect Effects 0.000 claims 1
- 230000008569 process Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 238000007689 inspection Methods 0.000 description 3
- 230000002093 peripheral effect Effects 0.000 description 3
- 238000013024 troubleshooting Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- FGRBYDKOBBBPOI-UHFFFAOYSA-N 10,10-dioxo-2-[4-(N-phenylanilino)phenyl]thioxanthen-9-one Chemical compound O=C1c2ccccc2S(=O)(=O)c2ccc(cc12)-c1ccc(cc1)N(c1ccccc1)c1ccccc1 FGRBYDKOBBBPOI-UHFFFAOYSA-N 0.000 description 1
- 241000403354 Microplus Species 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000011022 operating instruction Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000013102 re-test Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000005728 strengthening Methods 0.000 description 1
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Selective Calling Equipment (AREA)
- Control Of Velocity Or Acceleration (AREA)
Abstract
本发明公开了一种分布式低速高精度天文望远镜控制装置与方法,应用于天文望远镜分布式高精度控制。控制装置由现场控制盒、远程控制盒及PC控制台三部分组成。现场控制盒内含有驱动器、主操作面板;远程控制盒内含有远程操作面板;PC控制台由带RS485的工控机及运行在工控机上的操作软件组成。从设备远程控制盒、PC控制台通过RS485总线与主设备现场控制盒的主操作面板相互通信发出操作指令,实现主从分布式控制。主操作面板再通过CAN2.0总线向从设备驱动器发送运动控制指令、监控驱动器运行状态。驱动器与望远镜中的电机线及反馈线相连接,把运动控制指令进行功率放大输送给望远镜驱动电机,在功率放大内部实现有理速度位置牵引插补,实现精密控制。
The invention discloses a distributed low-speed high-precision astronomical telescope control device and method, which are applied to the distributed high-precision control of the astronomical telescope. The control device consists of three parts: on-site control box, remote control box and PC console. The field control box contains the driver and the main operation panel; the remote control box contains the remote operation panel; the PC console is composed of an industrial computer with RS485 and operating software running on the industrial computer. The remote control box of the slave device and the PC console communicate with the main operation panel of the field control box of the master device through the RS485 bus to issue operation instructions to realize master-slave distributed control. The main operation panel then sends motion control instructions to the slave device driver through the CAN2.0 bus, and monitors the running status of the driver. The driver is connected to the motor line and feedback line in the telescope, and the motion control command is amplified and sent to the telescope drive motor, and the rational speed and position traction interpolation is realized inside the power amplifier to achieve precise control.
Description
技术领域technical field
本发明涉及天文望远镜控制技术领域,尤其涉及天文望远镜的分布式低速高精度跟星控制。The invention relates to the technical field of astronomical telescope control, in particular to the distributed low-speed and high-precision star tracking control of the astronomical telescope.
背景技术Background technique
为观测天上的星星,得到星星的天文特性,希望星星在望远镜视野图像中保持静止,不出现像素漂移。由于地球自转,如果天文望远镜静止不动,则星星将以15角秒每秒自东向西运动。为确保星星在视野中静止,则望远镜同样需要以15角秒每秒的速度自东向西跟随运行。实验表明,两者的速度误差必须不超过0.01角秒/秒,星星在视野图像中的位置肉眼分辨不出移动,不出现像素漂移。因此,天文望远镜的控制有两个难点,一是极低的速度,15角秒/秒,几乎肉眼看不出来;二是速度的稳定性要求高,工作时间长,通常一颗星要连续观测几个小时,星星在几个小时内在视野中都不可发生变动。In order to observe the stars in the sky and obtain the astronomical characteristics of the stars, it is hoped that the stars will remain still in the image of the telescope field of view without pixel drift. Due to the rotation of the earth, if the astronomical telescope is stationary, the stars will move from east to west at 15 arc seconds per second. To ensure that the stars remain stationary in the field of view, the telescope also needs to follow them from east to west at a speed of 15 arcseconds per second. Experiments show that the speed error between the two must not exceed 0.01 arcsecond/second, and the position of the star in the field of view image cannot be distinguished by the naked eye, and there is no pixel drift. Therefore, there are two difficulties in the control of astronomical telescopes. One is the extremely low speed, 15 arc seconds per second, which is almost invisible to the naked eye; the other is high speed stability requirements and long working hours. Usually, a star needs to be continuously observed. For hours, the stars cannot change in the field of view for several hours.
同时,天文望远镜的工作室与天文望远镜有一定的空间距离。为实现可靠工作,一般望远镜的现场控制装置放置在望远镜附近,而操作人员通常在几米或几十米外的工作场所。At the same time, there is a certain space distance between the studio of the astronomical telescope and the astronomical telescope. In order to achieve reliable work, the on-site control device of the general telescope is placed near the telescope, and the operator is usually at the workplace several meters or tens of meters away.
目前现有的天文望远镜控制装置通过驱动器速度环实现望远镜的低速控制,或者通过运动控制卡加驱动器的方式实现低速控制,这两种方式的共同不足在于,速度控制虽然在平均意义上能较为准确地拟合星星的速度,但实际瞬时速度会不断变化,造成图像的波动。同时,很多天文望远镜仍然是单机控制系统,或只有一个操作界面,不能实现远程操控。At present, the existing astronomical telescope control device realizes the low-speed control of the telescope through the speed ring of the driver, or realizes the low-speed control through the motion control card plus the driver. Fitting the speed of the stars accurately, but the actual instantaneous speed will keep changing, resulting in fluctuations in the image. At the same time, many astronomical telescopes are still stand-alone control systems, or have only one operation interface, which cannot be remotely controlled.
本发明针对系统须高精度低速运动实现跟星、需多个完全一致的操作面板进行相同操作的情况,公开一种新型的分布式天文望远镜控制装置及低速高精度控制方法。The invention discloses a novel distributed astronomical telescope control device and a low-speed and high-precision control method for the situation that the system requires high-precision and low-speed movement to realize the same operation as the star and requires multiple identical operation panels.
本发明的优点在于,分布式的控制方式,可以同时接许多个操作节点。采用位置牵引及驱动器内插补的方式,不仅消除速度的误差,而且还消除速度误差的积分,实现进一步的稳速控制。同时,基于驱动器内插补,实现任意有理分数速度值的精确跟踪。The advantage of the present invention is that the distributed control mode can connect many operation nodes at the same time. The method of position traction and driver interpolation not only eliminates the speed error, but also eliminates the integral of the speed error to achieve further stable speed control. At the same time, based on interpolation within the driver, accurate tracking of any rational fractional speed value is realized.
发明内容Contents of the invention
为达到上述目的,本发明提出了一种分布式低速高精度天文望远镜控制装置与方法,应用于天文望远镜控制。该装置由现场控制盒、远程控制盒及PC控制台三部分组成。现场控制盒内含有驱动器、主操作面板;远程控制盒内含有远程操作面板;PC控制台由带RS485串行通信口的工控机及运行在工控机上的软件组成。In order to achieve the above purpose, the present invention proposes a distributed low-speed high-precision astronomical telescope control device and method, which are applied to the control of astronomical telescopes. The device consists of three parts: field control box, remote control box and PC console. The field control box contains the driver and the main operation panel; the remote control box contains the remote operation panel; the PC console is composed of an industrial computer with an RS485 serial communication port and software running on the industrial computer.
优选地,所述控制装置中的现场控制盒的主操作面板是主设备,远程控制盒的远程操作面板、PC控制台及驱动器为从设备。主操作面板与远程控制盒、PC控制台通过RS485串行总线相互通信,与驱动器通过CAN2.0串行总线相互通信,实现主从分布式控制。Preferably, the main operation panel of the field control box in the control device is a master device, and the remote operation panel, PC console and driver of the remote control box are slave devices. The main operation panel communicates with the remote control box and PC console through the RS485 serial bus, and communicates with the driver through the CAN2.0 serial bus to realize master-slave distributed control.
优选地,所述控制装置中现场控制盒的主操作面板不间断地接收来自远程控制盒及PC控制台的按键指令,并综合用户对主操作面板自身的按键操作指令,翻译成从设备驱动器能理解的对望远镜实施控制的操作指令,并下发给驱动器;同时主操作面板周期性收集驱动器的当前运行模式,监控驱动器的状态信息,在主操作面板显示并发布到远程控制盒及PC控制台显示。Preferably, the main operation panel of the field control box in the control device continuously receives the button commands from the remote control box and the PC console, and integrates the user's key operation instructions to the main operation panel itself, and translates them into slave device driver functions. Understand the operating instructions for controlling the telescope and issue them to the driver; at the same time, the main operation panel periodically collects the current operating mode of the driver, monitors the status information of the driver, displays it on the main operation panel and publishes it to the remote control box and PC console show.
优选地,所述的远程控制盒,用于响应自身的按键操作并向主操作面板上传操作指令,接收来自主操作面板的驱动器的运行状态,通过数码管显示其速度及状态,通过指示灯显示运行状态。Preferably, the remote control box is used to respond to its own key operation and upload operation instructions to the main operation panel, receive the running status of the driver from the main operation panel, display its speed and status through the digital tube, and display the speed and status through the indicator light Operating status.
优选地,所述的PC控制台,通过一操作软件实现虚拟操作面板,响应自身的按钮操作并向主操作面板上传操作指令,接收来自主操作面板的驱动器的运行状态,通过文字显示其速度及状态,通过虚拟指示灯显示运行状态。Preferably, the PC console implements a virtual operation panel through an operating software, responds to its own button operations and uploads operation instructions to the main operation panel, receives the running status of the driver from the main operation panel, and displays its speed and Status, the running status is displayed through the virtual indicator light.
优选地,所述现场控制盒中的驱动器用于响应主控制板发来的控制信息;根据主控制板发送的速度参数来控制云台的电机转动;当驱动器或电机发生错误时,发送错误信息给主控制板。Preferably, the driver in the field control box is used to respond to the control information sent by the main control board; control the motor rotation of the pan/tilt according to the speed parameters sent by the main control board; when an error occurs in the driver or the motor, send an error message to the main control board.
优选地,所属控制装置中的主操作面板,远程控制盒及PC控制台具有完全相同的操作界面。用户通过操作4*3按键阵列输入操作指令给天文望远镜;通过四位数码管及4*3LED灯观察装置的运行状态;通过电源指示灯观察上电状态。Preferably, the main operation panel, the remote control box and the PC console in the associated control device have exactly the same operation interface. The user inputs operation instructions to the astronomical telescope by operating the 4*3 button array; observes the operating status of the device through the four-digit digital tube and 4*3 LED lights; observes the power-on status through the power indicator light.
优选地,所述控制装置中现场控制盒、远程控制盒、PC控制台上的操作界面,其中按钮包括:加减拨码按键、恒动按钮、快进按钮、慢进按钮、微动加按钮、快退按钮、慢退按钮、微动减按钮、保留按钮、停止按钮、复位按钮;指示灯包括:报警灯、通信灯、恒动灯、快进灯、慢进灯、微动加灯、快退灯、慢退灯、微动减灯、电源灯、停止灯;数码显示包括:四位七段数码管。Preferably, the operation interface on the field control box, the remote control box, and the PC console in the control device, wherein the buttons include: plus and minus dial buttons, constant buttons, fast-forward buttons, slow-forward buttons, micro-motion plus buttons , fast rewind button, slow rewind button, micro-motion minus button, hold button, stop button, reset button; indicator lights include: alarm light, communication light, constant light, fast-forward light, slow-forward light, micro-motion plus light, Fast rewinding light, slow rewinding light, micro-motion reduction light, power light, stop light; digital display includes: four-digit seven-segment digital tube.
优选地,所述操作界面中,在恒动状态,按下加拨码按键,恒动速度将增大,并自动保存到内部flash中,该速度将保持,掉电后重启也不丢失,除非再次按下加减拨码按键;按下减拨码按键,恒动速度将减小,并自动保存到内部flash中,该速度将保持,掉电后重启也不丢失,除非再次按下加减拨码按键。恒动按钮按下,控制装置进入恒动状态,控制望远镜以地球自转速度恒速运行,星星在望远镜的视野内保持静止。快进按钮按下,控制装置进入快进状态,控制望远镜以快速朝正方向即地球自转的反方向前进,让望远镜快速搜索星星;快进按钮弹起,控制装置返回恒动状态。慢进按钮按下,控制装置进入慢进状态,控制望远镜以慢速朝正方向即地球自转的反方向前进,让望远镜慢速接近搜索星星;慢进按钮弹起,控制装置返回恒动状态。微动加按钮按下,控制装置进入微动加状态,控制望远镜以微动速度朝正方向即地球自转的反方向前进,让望远镜微动接近搜索星星;微动加按钮弹起,控制装置返回恒动状态。快退按钮按下,控制装置进入快退状态,控制望远镜以快速朝负方向即地球自转的方向前进,让望远镜快速搜索星星;快退按钮弹起,控制装置返回恒动状态。慢退按钮按下,控制装置进入慢退状态,控制望远镜以慢速朝反方向即地球自转方向前进,让望远镜慢速接近搜索星星;慢退按钮弹起,控制装置返回恒动状态。微动减按钮按下,控制装置进入微动减状态,控制望远镜以微动速度朝反方向即地球自转的方向前进,让望远镜微动接近搜索星星;微动减按钮弹起,控制装置返回恒动状态。停止按钮按下,望远镜将停止运动。复位按钮用于对按钮所在的操作界面进行复位。报警指示灯亮时,指示为故障状态。通信指示灯,用于指示当前通信状态,当处于正常状态时,指示灯长亮长灭交替;当处于错误状态时,将快闪长灭提示错误通信状态。恒动指示灯亮时,指示为恒动状态;快进指示灯亮时,指示为快进状态;慢进指示灯亮时,指示为慢进状态;微动加指示灯亮时,指示为微动加状态;快退指示灯亮时,指示为快退状态;慢退指示灯亮时,指示为慢退状态;微动减指示灯亮时,指示为微动减状态;电源指示灯用于指示工作状态,当上电时,该灯常亮。停止指示灯亮时,指示为停止状态。数码管根据不同的状态显示不同的速度值,当恒动状态时,显示恒动速度值;当快进状态时,显示快进速度值,等等。Preferably, in the operation interface, in the constant motion state, press the plus dial button, the constant motion speed will increase, and will be automatically saved in the internal flash, and the speed will be maintained, and will not be lost after power off, unless Press the addition and subtraction dial button again; press the subtraction dial button, the constant speed will decrease, and automatically save it in the internal flash, the speed will be maintained, and it will not be lost after restarting after power off, unless the addition and subtraction is pressed again Dial button. When the constant motion button is pressed, the control device enters a constant motion state, and the telescope is controlled to run at a constant speed of the earth's rotation speed, and the stars remain stationary within the field of view of the telescope. When the fast-forward button is pressed, the control device enters the fast-forward state, and the telescope is controlled to move forward quickly in the positive direction, that is, the opposite direction of the earth's rotation, so that the telescope can quickly search for stars; when the fast-forward button pops up, the control device returns to the constant motion state. When the slow-forward button is pressed, the control device enters the slow-forward state, and the telescope is controlled to advance slowly in the positive direction, that is, the opposite direction of the earth's rotation, so that the telescope slowly approaches to search for stars; when the slow-forward button pops up, the control device returns to the constant motion state. Press the micro-motion plus button, and the control device enters the micro-motion plus state, and controls the telescope to advance in the positive direction at the micro-motion speed, that is, the opposite direction of the earth's rotation, so that the telescope can approach and search for stars by micro-motion; the micro-motion plus button pops up, and the control device returns Perpetual state. When the rewind button is pressed, the control device enters the rewind state, and the telescope is controlled to move forward quickly in the negative direction, that is, the direction of the earth's rotation, so that the telescope can quickly search for stars; when the rewind button pops up, the control device returns to the constant motion state. When the slow back button is pressed, the control device enters the slow back state, and the telescope is controlled to advance slowly in the opposite direction, that is, the direction of the earth's rotation, so that the telescope slowly approaches to search for stars; when the slow back button pops up, the control device returns to the constant motion state. Press the micro-minus button, the control device enters the micro-minus state, and control the telescope to advance in the opposite direction at the micro-motion speed, that is, the direction of the earth's rotation, so that the telescope can approach and search for stars with micro-motion; the micro-minus button pops up, and the control device returns to constant dynamic state. When the stop button is pressed, the telescope will stop moving. The reset button is used to reset the operation interface where the button is located. When the alarm indicator light is on, it indicates a fault state. The communication indicator light is used to indicate the current communication status. When it is in a normal state, the indicator light will be on and off alternately; When the constant motion indicator light is on, it indicates the constant motion state; when the fast forward indicator light is on, it indicates the fast forward state; when the slow motion indicator light is on, it indicates the slow forward state; When the fast rewind indicator is on, it indicates the fast rewind state; when the slow rewind indicator is on, it indicates the slow rewind state; when the inching minus indicator is on, it indicates the inching minus state; the power indicator is used to indicate the working state, , the light is always on. When the stop indicator light is on, it indicates a stop state. The digital tube displays different speed values according to different states. When in the constant motion state, it displays the constant motion speed value; in the fast forward state, it displays the fast forward speed value, and so on.
优选地,所述现场控制盒内的驱动器,内部运行模式为,首先上电初始化,初始化后进行硬件自检,自检没有问题则进入空闲状态,如果发生错误则进入错误状态。主操作面板发送相应指令后,驱动器将从空闲状态切换到运行状态。运行状态下驱动器将以位置环工作。主操作面板还可以发送命令让驱动器重新自检。当运行状态遇到错误时,将进入错误状态。当错误原因排查之后,通过错误清除指令可让系统回到空闲状态。当希望停机时,主操作面板发送停机指令,驱动器进入停机状态。停机状态时若接收到启动命令可回到空闲状态。Preferably, the internal operation mode of the driver in the field control box is: firstly power on and initialize, and then perform hardware self-test after initialization, enter the idle state if there is no problem in the self-test, and enter the error state if there is an error. After the main operation panel sends corresponding commands, the driver will switch from idle state to running state. In the running state, the drive will work with a position loop. The main operator panel can also send commands to make the drive re-test itself. When the run state encounters an error, it enters the error state. After troubleshooting the cause of the error, the system can be returned to the idle state through the error clearing command. When it is desired to stop, the main operation panel sends a stop command, and the drive enters the stop state. It can return to the idle state if it receives a start command during the stop state.
优选地,所述天文望远镜低速高精度控制方法,通过内置于驱动器的位置牵引方法实现高稳定低速控制,给定有理分式的速度值。规定分母是位置环的周期数,分子是在这些位置周期数下必须行走的位移脉冲数。在每个位置环的单个周期内,进行直线插补,产生所需的位置指令,送给位置环,实现闭环位置伺服;完成分母个周期数后,又重新开始新的一轮速度周期,实现位置牵引,位置对时间的斜率是我们所需的速度值。Preferably, the low-speed high-precision control method of the astronomical telescope realizes high-stable low-speed control through the position pulling method built into the driver, and a rational fractional speed value is given. It is stipulated that the denominator is the cycle number of the position loop, and the numerator is the number of displacement pulses that must be walked under these position cycle numbers. In a single cycle of each position loop, linear interpolation is performed to generate the required position command, which is sent to the position loop to realize the closed-loop position servo; after completing the number of denominator cycles, a new round of speed cycle is restarted to realize Position traction, the slope of position versus time is the velocity value we need.
优选地,所述望远镜低速高精度控制方法,当有理分数的速度指令下发并发出执行指令时,首先进行初始化:把参考位置指令设置成反馈位置指令。根据速度分母与速度分子的大小划分为两种情况。当速度分母大于速度分子时,这定义为特殊的插补模式;当速度分子大于速度分母时,这定义为正常的插补模式。Preferably, in the low-speed and high-precision control method of the telescope, when a speed command of a rational fraction is issued and an execution command is issued, initialization is first performed: setting the reference position command as a feedback position command. According to the size of the velocity denominator and the velocity numerator, it can be divided into two cases. When the velocity denominator is greater than the velocity numerator, this is defined as a special interpolation mode; when the velocity numerator is greater than the velocity denominator, this is defined as a normal interpolation mode.
优选地,所述望远镜低速高精度控制方法,在特殊插补模式下,初始化插补参数C为速度分母减去两倍的速度分子绝对值、插补参数C1为负的两倍的速度分子绝对值、插补参数C2为速度分母减去速度分子绝对值的差值的两倍。在正常的插补模式下,初始化插补参数C为速度分子绝对值减去两倍的速度分母、插补参数C1为负的两倍的速度分母、插补参数C2为速度分子绝对值减去速度分母的差值乘以2。分子计数器、分母计数器清零。Preferably, in the low-speed and high-precision control method of the telescope, in the special interpolation mode, the initial interpolation parameter C is the speed denominator minus twice the absolute value of the speed numerator, and the interpolation parameter C1 is negative twice the speed numerator absolute value The value and the interpolation parameter C2 are twice the difference between the speed denominator minus the absolute value of the speed numerator. In the normal interpolation mode, the initial interpolation parameter C is the absolute value of the speed numerator minus twice the speed denominator, the interpolation parameter C1 is the negative double speed denominator, and the interpolation parameter C2 is the absolute value of the speed numerator minus The difference in velocity denominator is multiplied by 2. The numerator counter and denominator counter are cleared.
优选地,所述望远镜低速高精度控制方法,当初始化执行完毕后,在位置环的定时器周期,执行如下步骤:在正常插补情况下,如果分子计数器大于或等于速度分子,结束此轮速度分母周期数的插补,分子计数器、分母计数器清零,C重置速度分子绝对值减去两倍的速度分母,并将开启新一轮速度分母周期数的插补;如果分子计数器小于速度分子,判断参数C的正负,如果C大于零,分子计数器不断增加1,位置指令也增加或减小1,参数C赋值为C:=C+C1,直到C小于零为止,如果C已经小于零,则分子分母计数器都增加1,位置指令增加或减小1,参数C赋值为C:=C+C2。Preferably, in the low-speed high-precision control method of the telescope, after the initialization is completed, the following steps are performed in the timer period of the position loop: under normal interpolation, if the numerator counter is greater than or equal to the speed numerator, end this round of speed For the interpolation of the denominator cycle number, the numerator counter and the denominator counter are cleared, C resets the absolute value of the speed numerator minus twice the speed denominator, and a new round of interpolation of the speed denominator cycle number will be started; if the numerator counter is smaller than the speed numerator , to judge whether the parameter C is positive or negative. If C is greater than zero, the numerator counter is continuously increased by 1, and the position command is also increased or decreased by 1. The parameter C is assigned as C:=C+C1 until C is less than zero. If C is already less than zero , then both the numerator and denominator counters increase by 1, the position command increases or decreases by 1, and the parameter C is assigned as C:=C+C2.
优选地,所述望远镜低速高精度控制方法,当初始化执行完毕后,在位置环的定时器周期,执行如下步骤:在特殊插补模式下,如果分母计数器大于或等于速度分母,结束此轮速度分母周期数的插补,分子计数器、分母计数器清零,C重置速度分母减去两倍的速度分子绝对值,并将开始下一轮速度分母周期数的插补;如果分母计数器小于速度分母,则首先判断参数C的正负,如果C小于零,则计数分母增加,位置指令增加或减小1,参数C赋值为C:=C+C2;如果C大于零,则分母计数值加1,参数C赋值为C:=C+C1。Preferably, in the low-speed and high-precision control method of the telescope, after the initialization is completed, the following steps are performed in the timer period of the position loop: in the special interpolation mode, if the denominator counter is greater than or equal to the speed denominator, end this round of speed For the interpolation of the denominator cycle number, the numerator counter and the denominator counter are cleared, C resets the speed denominator minus twice the absolute value of the speed numerator, and will start the next round of interpolation of the speed denominator cycle number; if the denominator counter is smaller than the speed denominator , then first judge whether the parameter C is positive or negative. If C is less than zero, the counting denominator will increase, and the position command will increase or decrease by 1. The parameter C will be assigned C:=C+C2; if C is greater than zero, the denominator count value will be increased by 1. , the parameter C is assigned the value C:=C+C1.
优选地,所述望远镜低速高精度控制方法,通过直线插补产生的位置指令,将作为驱动器位置环周期中的输入指令信号给位置环,驱动器再运行位置环实现基于位置牵引的低速高精度速度控制。Preferably, in the low-speed and high-precision control method of the telescope, the position command generated by linear interpolation is used as an input command signal in the position loop cycle of the driver to the position loop, and the driver then operates the position loop to realize low-speed high-precision speed based on position traction control.
从上述方案可以看出,本发明具有以下优点:As can be seen from the above scheme, the present invention has the following advantages:
一是采用特殊的主从控制模式。该模式把实时通信与非实时通信区分开,实现了多节点有层次的分布式控制。在主操作面板与驱动器之间,采用CAN2.0实现实时可靠通信;而主面板与其他操作界面则采用RS485总线,实现长距离多节点的主从控制。而若以驱动器为主,按键板为从,将导致驱动器将在通信方面被占用系统资源太多,降低了驱动器的实时性。One is to adopt a special master-slave control mode. This mode distinguishes real-time communication from non-real-time communication, and realizes multi-node hierarchical distributed control. Between the main operation panel and the driver, CAN2.0 is used to realize real-time and reliable communication; while the main panel and other operation interfaces use RS485 bus to realize long-distance multi-node master-slave control. However, if the driver is the main driver and the keypad is the slave, the driver will be occupied by too many system resources in terms of communication, which will reduce the real-time performance of the driver.
二,主操作面板与现场控制盒、PC控制台实现了完全一致的操作界面,这使得操作简单可靠,即实现了多点操控,又实现了多点监控的目的。便于系统的进一步扩展。Second, the main operation panel and the on-site control box and PC console have completely consistent operation interface, which makes the operation simple and reliable, not only realizes multi-point control, but also realizes the purpose of multi-point monitoring. It is convenient for further expansion of the system.
三,内置于驱动器、与驱动器位置环同频率运行的有理分数的位置牵引速度直线插补方法,实现了无累积误差的低速高精度望远镜跟星控制。3. The linear interpolation method of position pulling speed with rational fraction built in the drive and running at the same frequency as the position loop of the drive realizes low-speed high-precision telescope follow-up control without cumulative error.
附图说明Description of drawings
图1系统组成示意图Figure 1 Schematic diagram of system composition
图2操作面板界面布局Figure 2 Operation panel interface layout
图3主操作面板控制软件流程图Figure 3 Flowchart of the main operation panel control software
图4远程控制盒及PC控制台软件流程图Figure 4 Remote Control Box and PC Console Software Flowchart
图5驱动器软件流程图Figure 5 Driver software flow chart
图6内置直线插补的位置环流程图Figure 6 Flow chart of position loop with built-in linear interpolation
图7直线内插补的初始化Figure 7 Initialization of linear interpolation
图8正常插补模式的一次执行Figure 8 One execution of normal interpolation mode
图9特殊插补模式的一次执行Figure 9 One execution of special interpolation mode
具体实施方式Detailed ways
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。In order to make the object, technical solution and advantages of the present invention clearer, the implementation manner of the present invention will be further described in detail below in conjunction with the accompanying drawings.
1、系统组成1. System composition
图1为本发明分布式低速高精度天文望远镜控制装置的结构示意图。该装置由现场控制盒、远程控制盒及PC控制台组成。Fig. 1 is a structural schematic diagram of the distributed low-speed high-precision astronomical telescope control device of the present invention. The device consists of a field control box, a remote control box and a PC console.
现场控制盒内含有驱动器、主操作面板。The field control box contains the driver and the main operation panel.
远程控制盒内含有远程操作面板。The remote control box contains the remote operation panel.
PC控制台由工控机及运行在工控机上的软件组成。The PC console is composed of an industrial computer and software running on the industrial computer.
现场控制盒的主操作面板有1路CAN2.0通信接口,1路RS485接口。The main operation panel of the field control box has 1 CAN2.0 communication interface and 1 RS485 interface.
现场控制盒的驱动器有1路CAN2.0通信接口。The driver of the field control box has a CAN2.0 communication interface.
远程操作面板带1路RS485接口。The remote operation panel has 1 RS485 interface.
PC控制台具有RS485通信接口。PC console has RS485 communication interface.
现场控制盒的主操作面板与驱动器通过CAN2.0实现实时通信。在实时通信中,主操作面板是主设备,驱动器是从设备。The main operation panel of the field control box and the driver realize real-time communication through CAN2.0. In real-time communication, the main operation panel is the master device, and the driver is the slave device.
现场控制盒的主操作面板与远程控制盒、PC控制台通过RS485实现多节点长距离通信。在RS485通信中,主操作面板是主设备,远程控制盒及PC控制台是从设备。The main operation panel of the field control box and the remote control box and PC console realize multi-node long-distance communication through RS485. In RS485 communication, the main operation panel is the master device, and the remote control box and PC console are slave devices.
现场控制盒的驱动器与天文望远镜的有刷驱动电机相连。驱动器与有刷电动机连接线包括两路电机线及电机的编码器反馈。The driver of the field control box is connected with the brush drive motor of the astronomical telescope. The connection line between the driver and the brushed motor includes two motor lines and the encoder feedback of the motor.
2操作面板2 operation panel
图2为本发明分布式低速高精度天文望远镜控制装置中主操作面板、远程控制盒及PC控制板的人机界面。Fig. 2 is the human-machine interface of the main operation panel, the remote control box and the PC control panel in the distributed low-speed high-precision astronomical telescope control device of the present invention.
在人机界面的上方,是四位八段数码管,用于显示当前运行状态下的速度信息。Above the man-machine interface is a four-digit eight-segment digital tube, which is used to display the speed information in the current running state.
在八段数码管的下方,是3*4阵列的按键。按键的旁边,有相对应的LED指示灯。从左到右,从上到下,按键依次为加键、减键、恒动键、快进键、慢进键、微动加键、快退键、慢退键、微动减键、保留、停止键、复位键。从左到右,从上到下,LED灯依次为报警灯、通信灯、恒动灯、快进灯、慢进灯、微动加灯、快退灯、慢退灯、微动减灯、电源灯、停止灯。Below the eight-segment digital tube is a 3*4 array of keys. Next to the buttons, there are corresponding LED indicators. From left to right, from top to bottom, the keys are plus key, minus key, constant key, fast forward key, slow forward key, micro plus key, fast rewind key, slow rewind key, micro minus key, reserve , stop key, reset key. From left to right, from top to bottom, the LED lights are alarm light, communication light, constant motion light, fast forward light, slow forward light, micro motion plus light, fast rewind light, slow back light, micro motion minus light, Power light, stop light.
在恒动状态,按下加拨码按键,恒动速度将增大,并自动保存到内部flash中,该速度将保持,掉电后重启也不丢失,除非再次按下加减拨码按键;按下减拨码按键,恒动速度将减小,并自动保存到内部flash中,该速度将保持,掉电后重启也不丢失,除非再次按下加减拨码按键。In the state of constant motion, press the plus dial button, the constant speed will increase and be automatically saved in the internal flash, the speed will be maintained, and it will not be lost after restarting after power failure, unless the plus or minus dial button is pressed again; Press the minus dial button, the constant speed will decrease, and it will be automatically saved in the internal flash, and the speed will be maintained, and it will not be lost after restarting after power failure, unless the plus and minus dial button is pressed again.
恒动按钮按下,控制装置进入恒动状态,控制望远镜以地球自转速度恒速运行,星星在望远镜的视野内保持静止。恒动按钮弹起,不改变恒动状态。When the constant motion button is pressed, the control device enters a constant motion state, and the telescope is controlled to run at a constant speed of the earth's rotation speed, and the stars remain stationary within the field of view of the telescope. The constant motion button pops up, and the constant motion state does not change.
快进按钮按下,控制装置进入快进状态,控制望远镜以快速朝正方向即地球自转的反方向前进,让望远镜快速搜索星星;快进按钮弹起,控制装置返回恒动状态。When the fast-forward button is pressed, the control device enters the fast-forward state, and the telescope is controlled to move forward quickly in the positive direction, that is, the opposite direction of the earth's rotation, so that the telescope can quickly search for stars; when the fast-forward button pops up, the control device returns to the constant motion state.
慢进按钮按下,控制装置进入慢进状态,控制望远镜以慢速朝正方向即地球自转的反方向前进,让望远镜慢速接近搜索星星;慢进按钮弹起,控制装置返回恒动状态。When the slow-forward button is pressed, the control device enters the slow-forward state, and the telescope is controlled to advance slowly in the positive direction, that is, the opposite direction of the earth's rotation, so that the telescope slowly approaches to search for stars; when the slow-forward button pops up, the control device returns to the constant motion state.
微动加按钮按下,控制装置进入微动加状态,控制望远镜以微动速度朝正方向即地球自转的反方向前进,让望远镜微动速度接近搜索星星;微动加按钮弹起,控制装置返回恒动状态。Press the micro-motion plus button, and the control device enters the micro-motion plus state, and controls the telescope to advance in the positive direction at the micro-motion speed, that is, the opposite direction of the earth's rotation, so that the telescope's micro-motion speed is close to searching for stars; the micro-motion plus button pops up, and the control device Return to the constant state.
快退按钮按下,控制装置进入快退状态,控制望远镜以快速朝负方向即地球自转的方向前进,让望远镜快速搜索星星;快退按钮弹起,控制装置返回恒动状态。When the rewind button is pressed, the control device enters the rewind state, and the telescope is controlled to move forward quickly in the negative direction, that is, the direction of the earth's rotation, so that the telescope can quickly search for stars; when the rewind button pops up, the control device returns to the constant motion state.
慢退按钮按下,控制装置进入慢退状态,控制望远镜以慢速朝反方向即地球自转方向前进,让望远镜慢速接近搜索星星;慢退按钮弹起,控制装置返回恒动状态。When the slow back button is pressed, the control device enters the slow back state, and the telescope is controlled to advance slowly in the opposite direction, that is, the direction of the earth's rotation, so that the telescope slowly approaches to search for stars; when the slow back button pops up, the control device returns to the constant motion state.
微动减按钮按下,控制装置进入微动减状态,控制望远镜以微动速度朝负方向即地球自转的方向前进,让望远镜微动速度接近搜索星星;微动减按钮弹起,控制装置返回恒动状态。Press the inching minus button, the control device enters the inching minus state, and controls the telescope to advance in the negative direction at the inching speed, that is, the direction of the earth's rotation, so that the telescope's inching speed is close to searching for stars; the inching minus button pops up, and the control device returns Perpetual state.
停止按钮按下,望远镜将停止运动。When the stop button is pressed, the telescope will stop moving.
复位按钮用于对按钮所在的操作界面进行复位。The reset button is used to reset the operation interface where the button is located.
图中报警指示灯亮时,指示为故障状态。When the alarm indicator light in the figure is on, it indicates a fault state.
通信指示灯,用于指示当前通信状态,当处于正常通信状态时,指示灯长亮长灭交替;当处于错误通信状态时,将快闪长灭提示错误状态。The communication indicator light is used to indicate the current communication status. When it is in the normal communication status, the indicator light will be on and off alternately; when it is in the error communication status, it will flash and off to indicate the error status.
恒动指示灯亮时,指示为恒动状态。When the constant motion indicator light is on, it indicates a constant motion state.
快进指示灯亮时,指示为快进状态。When the fast-forward indicator light is on, it indicates fast-forward status.
慢退指示灯亮时,指示为慢退状态。When the slow rewind indicator is on, it indicates the slow rewind state.
微动加指示灯亮时,指示为微动加状态。When the inching plus indicator light is on, it indicates the inching plus state.
快退指示灯亮时,指示为快退状态。When the rewind indicator light is on, it indicates fast rewind status.
慢进指示灯亮时,指示为慢进状态。When the slow-forward indicator light is on, it indicates the slow-forward state.
微动减指示灯亮时,指示为微动减状态。When the inching minus indicator light is on, it indicates the inching minus state.
电源灯亮时,指示系统已经上电。When the power light is on, it indicates that the system is powered on.
停止指示灯亮时,表示为停止状态。When the stop indicator light is on, it means it is in a stopped state.
数码管根据不同的状态显示不同的速度值,当恒动状态时,显示恒动速度值;当快进状态时,显示快进速度值,等等。The digital tube displays different speed values according to different states. When in the constant motion state, it displays the constant motion speed value; in the fast forward state, it displays the fast forward speed value, and so on.
3、主操作面板控制软件流程3. The main operation panel controls the software flow
图3为本发明主控制软件流程图,运行在现场控制盒的主操作面板上。Fig. 3 is a flow chart of the main control software of the present invention, running on the main operation panel of the field control box.
系统复位后进入初始化状态,首先进行外设及内部变量初始化工作,并让LED、数码管、按键处于初始状态,并等待驱动器完成初始化和自检工作。在初始化状态,按键是不起作用的。After the system is reset, it enters the initialization state. First, the peripherals and internal variables are initialized, and the LEDs, digital tubes, and keys are in the initial state, and wait for the driver to complete the initialization and self-test work. In the initialization state, the keys are ineffective.
初始化完毕后,系统进入自检状态。在自检状态:与驱动器进行通信,确保通信是正常的。读取驱动器内部状态,如果驱动器工作正常,会处于断强电状态,主操作面板写当前码盘数;如果驱动器不正常,则主操作面板根据驱动器的错误状态报警,提示出现错误,等待技术人员排查错误,就完成了自检工作。在自检状态,按键是不起作用的。After the initialization is complete, the system enters the self-test state. In the self-test state: communicate with the drive to ensure that the communication is normal. Read the internal state of the drive, if the drive works normally, it will be in the state of power failure, and the main operation panel will write the current number of code discs; if the drive is not normal, the main operation panel will alarm according to the error status of the drive, prompting an error, and wait for the technician After troubleshooting, the self-inspection work is completed. In the self-test state, the key does not work.
系统自检正常、或在停止状态时按下恒动键、或者搜索状态时快进、快退、慢进、慢退、微动加、微动减按键弹起,系统会发出加强电指令,进入恒动状态。在恒动状态,主操作面板会写入恒动运行参数,系统按照默认设定的恒动速度前进。但如果用户按下加键或减键,则可以微调速度,微调有上限和下限,这时候主操作面板会把新的速度指令下发。在恒动状态主操作面板会周期查询驱动器的状态,如果出现了错误,则主操作面板会进入错误状态进行报警。The system self-test is normal, or press the constant motion key in the stop state, or press the fast forward, fast reverse, slow forward, slow reverse, inching plus, inching minus buttons in the search state, the system will issue a strengthening electric command, into a state of perpetual motion. In the constant motion state, the main operation panel will write the constant motion running parameters, and the system will move forward at the default constant speed. However, if the user presses the plus or minus key, the speed can be fine-tuned, and the fine-tuning has an upper limit and a lower limit. At this time, the main operation panel will issue a new speed command. In the constant state, the main operation panel will query the state of the driver periodically. If an error occurs, the main operation panel will enter the error state and give an alarm.
在恒动状态或停止状态,如果按下快进、慢进、快退、慢退、微动加、微动减等按键,则进入搜索状态。在搜索状态,将以快进、慢进、快退、慢退、微动加、微动减等速度运行。当相应按键弹起,则将重新进入到恒动状态。在搜索状态主操作面板会周期查询驱动器的状态,如果出现了错误,则主操作面板会进入错误状态进行报警。In the state of constant motion or stop, if you press the keys of fast forward, slow forward, fast rewind, slow rewind, inching plus, inching minus, etc., it will enter the search state. In the search state, it will run at the speed of fast forward, slow forward, fast reverse, slow reverse, jog plus, jog minus, etc. When the corresponding button pops up, it will re-enter the constant motion state. In the search state, the main operation panel will query the state of the drive periodically, and if an error occurs, the main operation panel will enter the error state and give an alarm.
如果按下停止键则进入停止状态。在停止状态,会发出命令使驱动器停止运动,断强电。在搜索状态主操作面板会周期查询驱动器的状态,如果出现了错误,则主操作面板会进入错误状态进行报警。If the stop button is pressed, it enters the stop state. In the stopped state, a command will be issued to stop the drive and cut off the strong power. In the search state, the main operation panel will query the state of the drive periodically, and if an error occurs, the main operation panel will enter the error state and give an alarm.
当系统在自检、恒动、搜索、停止等状态,如果出现了运行错误时,会进入错误状态,会做出指示。等待用户排除故障。当故障排除完毕后,主操作面板可发出清除指令。当清除成功后,系统会跳到停止状态。When the system is in the state of self-test, constant motion, search, stop, etc., if there is an operation error, it will enter the error state and give instructions. Wait for user to troubleshoot. After the troubleshooting is completed, the main operation panel can issue a clearing command. When clearing is successful, the system will jump to stop state.
4、远程控制盒及PC控制台软件流程4. Remote control box and PC console software process
图4是运行在远程操作盒及PC控制台上的软件模块流程图,执行相同的功能。他们的流程如下:Fig. 4 is a flow chart of the software modules running on the remote operation box and the PC console, which perform the same functions. Their process is as follows:
首先是系统复位,然后进行初始化,给出各个按键、数码管及指示灯的初始状态。初始化完毕后,进入主扫描周期。First, the system is reset, and then initialized to give the initial state of each button, digital tube and indicator light. After initialization, enter the main scan cycle.
主扫描周期中,首先不断查询,主扫描周期标识位是否置1。如果是,将读入所有当前按键值的状态,并与上一循环的键值比较,根据按键键值的变化得出具体按键信息。如果没有任何按键的变化,则不做任何处理;如果有键被按下或弹起,按键信息将发送给上位机即主操作面板。当查询完按键信息,或者主扫描周期标识位为零,将查询是否有上位机发布的串口消息;如果有,则解析相应通信协议,得到系统当前的运行状态,根据最新的速度信息更新数码管显示,并更新指示灯的状态。In the main scan cycle, firstly, it is continuously inquired whether the flag bit of the main scan cycle is set to 1. If it is, it will read the state of all current key values, compare it with the key value of the previous cycle, and obtain specific key information according to the change of the key value. If there is no key change, no processing will be done; if any key is pressed or popped up, the key information will be sent to the host computer, which is the main operation panel. When the button information is checked, or the main scan cycle flag is zero, it will check whether there is a serial port message issued by the host computer; if there is, it will analyze the corresponding communication protocol to obtain the current operating status of the system, and update the digital tube according to the latest speed information Display, and update the state of the indicator light.
5、驱动器软件流程图5. Driver software flow chart
请参考图5,图5为本发明驱动器软件流程图。Please refer to FIG. 5 , which is a flowchart of the driver software of the present invention.
系统上电后,驱动器进行初始化工作,首先初始化外设,然后对系统初始化。After the system is powered on, the driver performs initialization work, first initializes the peripherals, and then initializes the system.
初始化完了后进行自检工作,检测各接口及MOS管是否工作正常,自检完毕,当一切正常时,进入空闲状态。当出现故障时,进入错误状态。After initialization, carry out self-inspection work, check whether each interface and MOS tube are working normally, after self-inspection is completed, when everything is normal, enter the idle state. When a failure occurs, enter the error state.
进入空闲状态后,功率管还是关闭的,由空闲状态可到达运行状态并可再次强制自检。After entering the idle state, the power tube is still closed, and the idle state can reach the running state and can be forced to self-test again.
进入运行状态,系统自动进入位置环状态,基于位置牵引的有理分数速度插补将运行于位置环内部。当运行结束时,可回到空闲状态或进入停机状态。Entering the running state, the system automatically enters the position loop state, and the rational fractional speed interpolation based on position traction will run inside the position loop. When the operation is over, it can return to the idle state or enter the shutdown state.
进入停机状态后,一切外设关闭,系统不能恢复到运行状态,只能重新上电。After entering the shutdown state, all peripherals are turned off, and the system cannot return to the running state, only to be powered on again.
进入错误状态后,首先根据错误号作出相应提示。当故障排除后将回到空闲状态。After entering the error state, it will first give a corresponding prompt according to the error number. Will return to idle state when the fault is corrected.
6、位置牵引直线插补的有理分数速度运行6. Rational fractional speed operation of position-driven linear interpolation
图6为位置牵引的有理分数速度直线插补方法在驱动器内部的流程图。当驱动器进入运行状态,自动进入直线插补位置环模式。在直线插补位置环模式下,等待位置环周期标识位置1,表示位置环周期到。当位置环周期到后,将执行直线内插补方法,生成位置环所需的位置指令并送给位置环。位置环根据位置指令及实际位置反馈进行闭环控制,实现位置伺服。直线内插补和位置环相结合,实现低速高精度的有理分数速度伺服。Fig. 6 is a flow chart of the position-driven rational fractional speed linear interpolation method inside the driver. When the drive enters the running state, it automatically enters the linear interpolation position loop mode. In the linear interpolation position loop mode, wait for the position of the position loop period indicator to be 1, indicating that the position loop period has arrived. When the position loop period is up, the linear interpolation method will be executed to generate the position command required by the position loop and send it to the position loop. The position loop performs closed-loop control according to the position command and actual position feedback to realize the position servo. The combination of linear interpolation and position loop realizes low-speed and high-precision rational fractional speed servo.
图7为直线内插补的初始化流程。该流程运行于图6中“执行一次直线内插补”环节。Fig. 7 is the initialization process of linear interpolation. This process runs in the link of "executing a linear interpolation" in Fig. 6 .
当新的速度指令到或第一次进入位置环运行,将进入直线内插补的初始化流程。首先我们根据所下达的速度指令,初始化指令的速度分子和速度分母。速度分子可正可负,速度分母一直是正数。并把位置反馈赋值给位置指令。并判断速度分子与速度分母的大小。When a new speed command arrives or enters the position loop operation for the first time, it will enter the initialization process of linear interpolation. First, we initialize the speed numerator and speed denominator of the command according to the speed command issued. The velocity numerator can be positive or negative, and the velocity denominator is always positive. And assign the position feedback to the position command. And judge the size of the speed numerator and the speed denominator.
当速度分子大于速度分母时,进入正常插补模式。在正常插补模式下,初始化插补参数C为速度分子绝对值减去两倍的速度分母、插补参数C1为负的两倍的速度分母、插补参数C2为速度分子绝对值减去速度分母的差值乘以2。When the speed numerator is greater than the speed denominator, enter the normal interpolation mode. In normal interpolation mode, the initial interpolation parameter C is the absolute value of the speed numerator minus twice the speed denominator, the interpolation parameter C1 is the negative double speed denominator, and the interpolation parameter C2 is the absolute value of the speed numerator minus the speed The difference in denominator is multiplied by 2.
当速度分母大于速度分子时,进入特殊插补模式。在特殊插补模式下,初始化插补参数C为速度分母减去两倍的速度分子绝对值、插补参数C1为负的两倍的速度分子绝对值、插补参数C2为速度分母减去速度分子绝对值的差值的两倍。When the speed denominator is greater than the speed numerator, enter the special interpolation mode. In the special interpolation mode, the initial interpolation parameter C is the absolute value of the speed denominator minus twice the speed numerator, the interpolation parameter C1 is the negative double the absolute value of the speed numerator, and the interpolation parameter C2 is the speed denominator minus the speed Twice the difference in absolute value of the numerator.
初始化C,C1及C2后,分子计数器、分母计数器清零。直线插补初始化结束。After initializing C, C1 and C2, the numerator counter and denominator counter are cleared. Linear interpolation initialization is completed.
图8为正常插补模式的一次执行。当驱动器进入正常插补模式后,首先判断分子计数器是否大于等于速度分子。如果是,表明上一轮的一次有理分数速度已经执行完毕,执行的距离是速度分子绝对值,执行的时间是速度分母,并将进行新一轮的有理分数速度执行,这时分子计数器清零,初始化参数C为速度分子的绝对值减去两倍的速度分母的差值,开始新一轮的插补。Figure 8 is an execution of the normal interpolation mode. When the drive enters the normal interpolation mode, it first judges whether the numerator counter is greater than or equal to the speed numerator. If it is, it means that the last round of rational fractional speed has been executed, the executed distance is the absolute value of the speed numerator, the execution time is the speed denominator, and a new round of rational fractional speed will be executed, and the numerator counter will be cleared at this time , the initialization parameter C is the difference between the absolute value of the velocity numerator minus twice the velocity denominator, and a new round of interpolation starts.
如果分子计数器小于速度分子,或者已经完成了新一轮插补的初始化,循环判断C是否大于零。如果C大于零,判断分子计数器是否大于等于速度分子,如果大于等于,则结束此次内插补,如果小于,则分子计数器加1,如果速度分子大于零,位置指令增加1脉冲,如果速度分子小于零位置指令减小1脉冲,并更新参数C,C等于C加上C1,并继续循环判断C是否大于零,直到C小于等于零为止。If the numerator counter is smaller than the velocity numerator, or the initialization of a new round of interpolation has been completed, the loop judges whether C is greater than zero. If C is greater than zero, judge whether the numerator counter is greater than or equal to the speed numerator, if it is greater than or equal to, then end this interpolation, if less than, then add 1 to the numerator counter, if the speed numerator is greater than zero, add 1 pulse to the position command, if the speed numerator Less than zero position command reduces 1 pulse, and updates parameter C, C is equal to C plus C1, and continues to loop to judge whether C is greater than zero, until C is less than or equal to zero.
如果C小于等于零,判断分子计数器是否大于速度分子,如果大于等于,则结束此次内插补;如果小于,则分子计数器加1,分母计数器加1,如果速度分子大于零,位置指令增加1脉冲,如果速度分子小于零位置指令减小1脉冲,并更新参数C,C等于C加上C2,结束此次内插补。If C is less than or equal to zero, judge whether the numerator counter is greater than the speed numerator, if greater than or equal to, end this interpolation; if less than, then add 1 to the numerator counter, add 1 to the denominator counter, if the speed numerator is greater than zero, add 1 pulse to the position command , if the speed numerator is less than the zero position command, reduce 1 pulse, and update the parameter C, C is equal to C plus C2, and end this interpolation.
图9为特殊插补模式的一次执行。首先判断分母计数器是否小于速度分母。Figure 9 is an execution of the special interpolation mode. First judge whether the denominator counter is less than the speed denominator.
如果是,继续判断C是否小于等于零,如果小于等于零,则分母计数器增加1,如果速度分子大于零,位置指令增加1,如果速度分子小于零,位置指令减小1,C赋值为C加上C2,结束此次内插补;如果C大于零,分母计数器增加1,C赋值为C加上C1,结束此次内插补。If it is, continue to judge whether C is less than or equal to zero. If it is less than or equal to zero, the denominator counter increases by 1. If the speed numerator is greater than zero, the position command increases by 1. If the speed numerator is less than zero, the position command decreases by 1. C is assigned C plus C2 , end this interpolation; if C is greater than zero, the denominator counter increases by 1, C is assigned C plus C1, and this interpolation ends.
如果否,分子分母计数器清零,C初始化为速度分母减去2倍的速度分子绝对值的差值,并结束此次内插补。If not, the numerator and denominator counters are cleared, C is initialized to the difference between the speed denominator minus 2 times the absolute value of the speed numerator, and this interpolation ends.
以上实施例提供的技术方案中的全部或部分内容可以通过软件编程实现,其软件程序存储在可读取的存储介质中,存储介质例如:计算机中的硬盘、光盘或软盘。All or part of the technical solutions provided by the above embodiments can be realized by software programming, and the software program is stored in a readable storage medium, such as a hard disk, an optical disk or a floppy disk in a computer.
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。The above descriptions are only preferred embodiments of the present invention, and are not intended to limit the present invention. Any modifications, equivalent replacements, improvements, etc. made within the spirit and principles of the present invention shall be included in the protection of the present invention. within range.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310526148.4A CN103543735B (en) | 2013-10-30 | 2013-10-30 | Distributed type low-speed high-precision device for controlling astronomical telescope |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310526148.4A CN103543735B (en) | 2013-10-30 | 2013-10-30 | Distributed type low-speed high-precision device for controlling astronomical telescope |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103543735A true CN103543735A (en) | 2014-01-29 |
CN103543735B CN103543735B (en) | 2017-02-08 |
Family
ID=49967296
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310526148.4A Expired - Fee Related CN103543735B (en) | 2013-10-30 | 2013-10-30 | Distributed type low-speed high-precision device for controlling astronomical telescope |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103543735B (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107077155A (en) * | 2016-08-22 | 2017-08-18 | 深圳市大疆灵眸科技有限公司 | Imaging apparatus control method, system and equipment |
CN107643770A (en) * | 2017-09-15 | 2018-01-30 | 中国科学院长春光学精密机械与物理研究所 | A kind of telescope control system and method |
CN108549343A (en) * | 2018-04-27 | 2018-09-18 | 湖南文理学院 | A kind of kinetic control system and control method based on big data |
CN118590611A (en) * | 2024-05-17 | 2024-09-03 | 中国人民解放军军事科学院系统工程研究院 | A distributed space observation system and method |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004170695A (en) * | 2002-11-20 | 2004-06-17 | Yamaha Corp | Astronomical telescope control system |
WO2004107013A1 (en) * | 2003-05-30 | 2004-12-09 | Vixen Co., Ltd. | Automatic introduction device for celestial bodies, terminal device, and astronomical telescope control system |
CN2911764Y (en) * | 2006-02-05 | 2007-06-13 | 云南大学 | Electric driver for controlling astronomical telescope to automatically track celestial body targets |
CN101174783A (en) * | 2007-10-31 | 2008-05-07 | 中国科学院国家天文台南京天文光学技术研究所 | Arc Drive Large Aperture Astronomical Telescope |
CN101183173A (en) * | 2007-11-02 | 2008-05-21 | 中国科学院国家天文台南京天文光学技术研究所 | A Control Method for Arc Motion of Large Aperture Astronomical Telescope |
CN102494599A (en) * | 2011-11-01 | 2012-06-13 | 中国科学院国家天文台南京天文光学技术研究所 | Position detection method of large-calibre millimetre wave/sub-millimetre wave telescope control system |
-
2013
- 2013-10-30 CN CN201310526148.4A patent/CN103543735B/en not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004170695A (en) * | 2002-11-20 | 2004-06-17 | Yamaha Corp | Astronomical telescope control system |
WO2004107013A1 (en) * | 2003-05-30 | 2004-12-09 | Vixen Co., Ltd. | Automatic introduction device for celestial bodies, terminal device, and astronomical telescope control system |
CN2911764Y (en) * | 2006-02-05 | 2007-06-13 | 云南大学 | Electric driver for controlling astronomical telescope to automatically track celestial body targets |
CN101174783A (en) * | 2007-10-31 | 2008-05-07 | 中国科学院国家天文台南京天文光学技术研究所 | Arc Drive Large Aperture Astronomical Telescope |
CN101183173A (en) * | 2007-11-02 | 2008-05-21 | 中国科学院国家天文台南京天文光学技术研究所 | A Control Method for Arc Motion of Large Aperture Astronomical Telescope |
CN102494599A (en) * | 2011-11-01 | 2012-06-13 | 中国科学院国家天文台南京天文光学技术研究所 | Position detection method of large-calibre millimetre wave/sub-millimetre wave telescope control system |
Non-Patent Citations (3)
Title |
---|
李成刚 等: "大射电望远镜精调平台建模与控制系统方案研究", 《机械设计与研究》 * |
王卫东: "大射电望远镜精调Stewart平台非线性PID控制", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
郝娟 等: "大射电望远镜馈源精调平台控制系统的研究与开发", 《机械科学与技术》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107077155A (en) * | 2016-08-22 | 2017-08-18 | 深圳市大疆灵眸科技有限公司 | Imaging apparatus control method, system and equipment |
CN107643770A (en) * | 2017-09-15 | 2018-01-30 | 中国科学院长春光学精密机械与物理研究所 | A kind of telescope control system and method |
CN108549343A (en) * | 2018-04-27 | 2018-09-18 | 湖南文理学院 | A kind of kinetic control system and control method based on big data |
CN108549343B (en) * | 2018-04-27 | 2020-11-27 | 湖南文理学院 | A motion control system and control method based on big data |
CN118590611A (en) * | 2024-05-17 | 2024-09-03 | 中国人民解放军军事科学院系统工程研究院 | A distributed space observation system and method |
Also Published As
Publication number | Publication date |
---|---|
CN103543735B (en) | 2017-02-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103543735B (en) | Distributed type low-speed high-precision device for controlling astronomical telescope | |
US10019303B2 (en) | Method for error monitoring, control and data transmission installation and control device | |
US20200310733A1 (en) | Programmable Display And Programmable Logic Controller System Including The Same | |
JP6477319B2 (en) | Plant control system | |
CN104159016A (en) | Cradle head control system, method and device | |
US11782431B2 (en) | Control device and non-transitory computer-readable recording medium recording program | |
CN103259470A (en) | Stepping motor movement system supporting a plurality of working modes | |
WO2016188317A1 (en) | Projection device, control method thereof and computer readable storage medium | |
CN108111766A (en) | A kind of camera method of controlling rotation and terminal and medium product | |
WO2021068927A1 (en) | Reloading device and reloading device-based focusing method | |
US20100083110A1 (en) | Human-machine interface having multiple touch display navigation capabilities | |
CN203415155U (en) | PLC practical training platform for teaching | |
JPWO2020044909A1 (en) | Industrial equipment control device and industrial equipment data collection system | |
US20140309751A1 (en) | Controller, device control system, computer program, computer readable storage medium | |
CN102163093A (en) | Method and device for simulating external access of mouse by using rocker | |
JP6680811B2 (en) | Processing time prediction device | |
WO2021169815A1 (en) | Remote operation control system, method, terminal, and storage medium | |
JP4044105B2 (en) | Numerical control device having function of switching operation means for each system | |
CN201689341U (en) | Portable model attitude control device for low-speed wind tunnels | |
CN103308285A (en) | Filter wheel and focusing control liquid crystal display system of space camera | |
CN102253571A (en) | Camera equipment and infrared optical filter switching device | |
CN117230417A (en) | Control system and method for magnetron sputtering rotary target vacuum coating machine | |
KR100899651B1 (en) | Video Surveillance and Touch Screen Control System and Method for Remote Site Control Panel Management | |
WO2023053544A1 (en) | Control system | |
CN209625203U (en) | Power & environment supervision serial ports distributing equipment |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170208 |