Control device of tilt angle sensor debugging rotary table motor

By designing the servo control board and chassis device, the automatic control of the inclination sensor debugging rotary table motor is realized, the automation control problem in the existing technology is solved, and the high-precision and low-cost automated debugging effect is achieved.

CN118944539APending Publication Date: 2024-11-12ZHICHUAN TECH (ZHEJIANG) CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411030525.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-30
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

The prior art is difficult to realize automated control of the inclination sensor debugging turntable motor, and there is a lack of effective control devices to meet the needs of high precision and automated debugging.

Method used

A control device including a chassis, servo control board, servo motor driver and fan is designed. The servo control board communicates with the upper computer through the 232 serial port module, uses servo motor driver to control the turntable motor, reserve redundant circuits to prevent failure, and Includes a test interface to achieve precise control of the turntable motor.

Benefits of technology

It realizes high-precision control of the inclination sensor debugging turntable motor, with simple structure, rich functions, low cost, easy operation, meets the requirements of automated debugging, and reserves redundant circuits for expansion and fault protection.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118944539A_ABST
    Figure CN118944539A_ABST
Patent Text Reader

Abstract

The invention relates to a control device for debugging a rotary table motor by a tilt angle sensor, which is used for realizing automatic control on the rotary table motor and comprises a case as well as a switching power supply, a servo motor driver, a servo control board and a fan which are arranged in the case, the switching power supply is connected with an external three-phase power supply for supplying power; the servo control board is communicated with an upper computer and controls the rotary table motor through the servo motor driver, and the fan is connected with the servo control board. Compared with the prior art, the device has the advantages of simple structure, rich functions, low cost, easiness in operation and the like.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of automatic control of turntable motors, in particular to a control device for debugging turntable motors with an inclination sensor. Background Art

[0002] In the process of producing inclination sensors, it is necessary to debug and test the inclination sensor products. The inclination sensor products to be tested are installed on a high-precision turntable through a tooling plate, and the turntable is rotated by controlling the drive motor of the turntable. It is rotated to various debugging angle positions and then cooperates with the host computer to complete the angle debugging. In order to realize automatic control of the turntable rotation and meet the requirements of automated debugging, a control device for debugging the turntable motor of the inclination sensor is needed. Summary of the invention

[0003] The purpose of the present invention is to overcome the defects of the above-mentioned prior art and to provide a control device for debugging a turntable motor of an inclination sensor to realize automatic control of the turntable motor. The device includes a chassis and a switching power supply, a servo motor driver, a servo control board and a fan installed in the chassis. The switching power supply is connected to an external three-phase power supply for power supply, the servo control board communicates with a host computer and controls the turntable motor through the servo motor driver, and the fan is connected to the servo control board.

[0004] Furthermore, the chassis is a rectangular box, and a main power switch and a power-on indicator light are provided on the outside of the front panel. The main power switch is arranged between the three-phase power supply and the switching power supply. The servo control board is fixed on the inside of the front panel. A plurality of grille holes are provided on the side panels of the chassis. The fan is installed on the inside of the side panels opposite the grille holes. A handle is provided on the top of the chassis. A square wire outlet hole and a circular wire outlet hole are provided on the rear panel of the chassis. The switching power supply is installed on the servo control board.

[0005] Furthermore, the servo control board includes a power module, a main control chip and peripheral circuits, a 232 serial port module, a status indicator light module, a motor enable module, a signal indicator light module and a servo motor driver communication module. The switching power supply is powered by the power module, the main control chip communicates with the host computer through the 232 serial port module, the main control chip communicates with the servo motor driver through the motor enable module and the DB-9 interface, and the main control chip communicates with the servo motor driver through the servo motor driver communication module and the DB-9 interface, and the status indicator light module and the signal indicator light module are respectively connected to the main control chip.

[0006] Furthermore, the servo control board also includes a USB interface redundancy module. When the 232 serial port module fails, the main control chip communicates with the host computer through the USB interface redundancy module.

[0007] Furthermore, the servo control board also includes a relay redundancy module. When the motor enabling module fails, the main control chip communicates with the servo motor driver through the relay redundancy module and the DB-9 interface.

[0008] Furthermore, the power supply module includes a 24V input circuit, a 6.8V voltage conversion circuit, a 5V voltage conversion circuit, a 3.3V voltage conversion circuit and a fan power supply circuit, the 24V input circuit is respectively connected to the switching power supply, the 6.8V voltage conversion circuit, the fan power supply circuit, the motor enable module and the relay redundancy module, the 6.8V voltage conversion circuit is respectively connected to the 5V voltage conversion circuit and the 3.3V voltage conversion circuit, and the fan power supply circuit is connected to the fan.

[0009] Furthermore, the 232 serial port module includes a 232 communication chip, the signal input end of the 232 communication chip is connected to the TTL signal output end of the main control chip, and the signal output end communicates with the host computer through a DB-9 connector.

[0010] Furthermore, the motor enabling module includes a power load switch chip, the pin 1 output end of the power load switch chip is grounded through a varistor and a ground resistor, pin 2 is grounded after passing through a current limiting protection resistor R22, pin 3 is connected to the signal output end Pout of the main control chip through a resistor, and pin 4 is connected to the 24V input circuit.

[0011] Furthermore, the servo motor driver communication module includes a signal amplifying chip, and the control signal end of the main control chip is connected to the DB-9 interface correspondingly after signal amplification processing is performed by the signal amplifying chip.

[0012] Furthermore, the servo control board is also provided with a test port for testing various signal functions of the main control chip.

[0013] Furthermore, the control device performs the following steps to debug the turntable motor using the inclination sensor:

[0014] The host computer 7 sends a TTL control command signal to the 232 serial port module 42 through the DB-9 connector J2 and converts it into a 232 signal to the main control chip U5; after receiving the control command, the main control chip U5 sends a high-level signal to the motor enable module 45, so that the power load switch chip U6 outputs a 24V voltage and provides a 24V starting power supply to the servo motor driver 2 through the DB-9 interface J3. In addition, the main control chip U5 sends a PWM signal for controlling the motor speed and a high and low level signal for controlling the forward and reverse rotation of the motor to the servo motor driver 2 through the DB-9 interface J3. After receiving the PWM signal and the high and low level signals, the servo motor driver 2 controls the inclination sensor debugging turntable motor to rotate to the angle required for debugging.

[0015] The purpose of the present invention can be achieved by the following technical solutions:

[0016] Compared with the prior art, the present invention realizes precise control of the Yaskawa motor of the tilt sensor test turntable through a self-designed servo control board circuit and chassis, and also reserves redundant circuits for expansion and failure prevention. In addition, a test interface is designed for easy use during testing. It has a simple structure, rich functions, low cost, and easy operation. It can meet the requirements of automated debugging by cooperating with the automatic debugging software of the host computer. BRIEF DESCRIPTION OF THE DRAWINGS

[0017] Figure 1 It is a schematic diagram of the principle of the present invention.

[0018] Figure 2 It is a schematic diagram of the structure of the chassis, wherein Figure (2a) is a front view, Figure (2b) is a side view, Figure (2c) is a rear view, Figure (2d) is a top view, and Figure (2e) is an axonometric view.

[0019] Figure 3 This is a schematic diagram of the servo control board.

[0020] Figure 4a This is the circuit structure diagram of the 24V input circuit.

[0021] Figure 4b This is the circuit structure diagram of the 6.8V voltage conversion circuit.

[0022] Figure 4c It is the circuit structure diagram of 5V voltage conversion circuit and 3.3V voltage conversion circuit.

[0023] Figure 4d Circuit diagram of the fan power supply circuit.

[0024] Figure 5 This is the circuit structure diagram of the main control chip and peripheral circuits.

[0025] Figure 6 This is the circuit structure diagram of the 232 serial port module.

[0026] Figure 7 This is the circuit structure diagram of the USB interface redundancy module.

[0027] Figure 8 This is the circuit structure diagram of the status indicator light module.

[0028] Fig. 9 This is the circuit structure diagram of the motor enable module.

[0029] Fig.10 This is the circuit diagram of the relay redundancy module.

[0030] Fig.11 This is the circuit structure diagram of the signal indicator light module.

[0031] Fig.12 This is the circuit structure diagram of the servo motor driver communication module.

[0032] Description of reference numerals:

[0033] 1. Yaskawa servo motor, 2. servo motor driver, 3. switching power supply, 4. servo control board, 41. power module, 42. 232 serial port module, 43. USB interface redundancy module, 44. status indicator module, 45. motor enable module, 46. relay redundancy module, 47. signal indicator module, 48. servo motor driver communication module, 5. fan, 6. chassis, 7. host computer, 8. three-phase power supply. DETAILED DESCRIPTION

[0034] The present invention is described in detail below in conjunction with the accompanying drawings and specific embodiments. This embodiment is implemented based on the technical solution of the present invention, and provides a detailed implementation method and specific operation process, but the protection scope of the present invention is not limited to the following embodiments.

[0035] It should be noted that in this specification, similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, it does not need to be further defined and explained in the subsequent drawings.

[0036] In the description of this embodiment, it should be noted that the terms "upper", "lower", "inner", "bottom", etc. indicate orientations or positional relationships based on the orientations or positional relationships shown in the accompanying drawings, or are the orientations or positional relationships in which the inventive product is usually placed when used. They are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on the present invention.

[0037] The terms “first”, “second”, etc. are only used for distinguishing descriptions and should not be understood as indicating or implying relative importance.

[0038] In the description of this embodiment, it is also necessary to explain that, unless otherwise clearly specified and limited, the terms "set", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in this embodiment can be understood according to specific circumstances.

[0039] To make the objectives, technical solutions and advantages of the present invention more clear, the embodiments of the present invention will be further described in detail below with reference to the accompanying drawings.

[0040] Example

[0041] like Figure 1 As shown, the present invention provides a control device for an inclination sensor debugging turntable motor, the device includes a chassis 6 and a switching power supply 3, a servo motor driver 2, a servo control board 4 and a fan 5 arranged in the chassis 6, the switching power supply 3 is connected to an external three-phase power supply 8 to power the servo motor driver 2 and the servo control board 4, the servo control board 4 communicates with a host computer 7, and controls the Yaskawa servo motor 1 through the servo motor driver 2 to achieve high-precision control of the inclination sensor debugging turntable, and the fan 5 is connected to the servo control board 4 to achieve ventilation and heat dissipation inside the chassis 6.

[0042] like Figure 2 As shown, the chassis 6 is a rectangular box, and a main power switch S1 and a power-on indicator light are provided on the outside of the front panel. The main power switch is used to control the on and off of the external three-phase power supply 8 and the switching power supply 3, and the indicator light is used to indicate whether the power-on is normal. The servo control board 4 is fixed to the inner side of the front panel by three screws, and a plurality of grid holes are provided on the side panel of the chassis 6. The fan 5 is fixed to the inner side of the side panel opposite to the grid holes by screws. A handle is provided on the top of the chassis 6 for easy transportation. Two outlet holes are provided on the rear panel of the chassis 6, including a square outlet hole and a circular outlet hole, wherein the square outlet hole is an outlet hole for connecting the servo control board 4 with the host computer 7, and the circular outlet hole is an outlet hole shared by the power line connecting the external three-phase power supply 8 with the switching power supply 3 and the connecting line connecting the servo motor driver 2 with the Yaskawa servo motor 1. The servo control board 4 is also fixed to the inner side of the side panel with the grid holes by screws, and the switching power supply 3 is installed on the servo control board 4.

[0043] like Figure 3As shown, as the core component of the control device of the tilt sensor debugging turntable motor of the present invention, the servo control board 4 includes a power module 41, a main control chip U5 and peripheral circuits, a 232 serial port module 42, a USB interface redundancy module 43, a status indicator light module 44, a motor enable module 45, a relay redundancy module 46, a signal indicator light module 47, and a servo motor driver communication module 48. The switch power supply 3 supplies power to the main control chip U5 through the power module 41, and the main control chip U5 communicates with the host computer 7 through the 232 serial port module 42 using the 232 serial port communication method (when the 232 serial port module 42 fails, it can be The USB interface redundancy module 43 communicates with the host computer 7 using the USB communication method), the main control chip U5 is connected to the DB-9 interface J3 through the motor enable module 45, and the DB-9 interface J3 communicates with the servo motor driver 2 (when the motor enable module 45 fails, it can be connected to the DB-9 interface J3 using the relay method through the relay redundancy module 46), and the main control chip U5 is connected to the DB-9 interface through the servo motor driver communication module 48 to realize communication with the servo motor driver 2; the status indicator light module 44 and the signal indicator light module 47 are respectively connected to the main control chip U5 to realize status and signal indication.

[0044] The power module 41 is connected to the switching power supply 3 to provide +24V, +6.8V, +5V and +3.3V voltage outputs, including a 24V input circuit, a 6.8V voltage conversion circuit, a 5V voltage conversion circuit, a 3.3V voltage conversion circuit and a fan power supply circuit.

[0045] like Figure 4a As shown, in the 24V input circuit, the J1 port is connected to the switching power supply 3, and a 24V voltage (24V_INPUT) is input from the J1 port. M1 is a varistor, and F1 is a recoverable fuse. In this example, 100mA / 30V is preferably selected to protect against excessive current. D10 is an overvoltage protection device, preferably 40V overvoltage protection. D0 is a unidirectional conducting diode to prevent reverse connection. C1 is a filter capacitor between the first output terminal Vin of the 24V input circuit and pin 1 of the chip U1. In addition, the 24V voltage input (24V_INPUT) is connected to pin 4 of the chip U6 as the second output terminal Servor_24V of the 24V input circuit after passing through the recoverable fuse F2 (also connected to the relay K1 switch of the relay module 46).

[0046] like Figure 4bAs shown, the 6.8V voltage conversion circuit includes a power management chip U1 and peripheral circuits, which are used to convert the first output terminal Vin of the 24V input circuit into a 6.8V voltage output. The power management chip U1 model is TD1509PR, and its voltage output Vout = 1.23*(1+R2 / R1), D9 is the output rectifier diode, L1 is the output inductor, C3 and C4 are both output capacitors, and C2 is a feedforward capacitor (which can be unsoldered).

[0047] like Figure 4c As shown, the input ends of the 5V voltage conversion circuit and the 3.3V voltage conversion circuit are respectively connected to the output end of the 6.8V voltage conversion circuit to convert the +6.8V voltage into a +5V voltage and a +3.3V voltage. C13 and C15 are input filter capacitors. The 6.8V voltage is converted into a 3.3V output through a chip U3 (model LM1117-3.3), and is converted into a 5V output through a chip U4 (model LM1117-5.0). C25 and C27 are 5V output capacitors, and C24 and C26 are 3.3V output filter capacitors.

[0048] like Figure 4d As shown, in the fan power supply circuit, the chip U2 (model TD1509PR) and the peripheral circuit are used to convert the first output terminal Vin of the 24V input circuit into a 5V voltage output to the fan power supply interface J8, and the fan power supply interface J8 is connected to the fan 5, and its voltage output Vout = 1.23*(1+R42 / R41), D20 is the output rectifier diode, L2 is the output inductor, C43 and C44 are the output capacitors, C42 is the feedforward capacitor (can be unsoldered), D21 is the overvoltage protection diode, and R100 is the current limiting resistor, which uses 1k ohms in this example.

[0049] like Figure 5 As shown, the model of the main control chip U5 is STM32F103CB, J6 is the burning port, its pin 1 D3.3V is connected to the pin 1 of the main control chip U5, its pin 2 SWDIO is connected to the pin 34 of the main control chip U5, its pin 3 SWCLK is connected to the pin 37 of the main control chip U5, and pin 4 is grounded.

[0050] Pins 1, 24, 48, and 36 of the main control chip U5 are connected to 3.3V voltage output respectively, C32, C19, C18, C17, and C16 are all ground filter capacitors, pin 9 is connected to D3.3V, C14 is a ground filter capacitor, and pins 8, 23, 35, and 47 are grounded.

[0051] D3.3V is connected to pin 7 of the main control chip U5 through resistor R24, and C21 is the ground filter capacitor of pin 7.

[0052] Crystal oscillator Y2 is connected to pins 5 and 6 of the main control chip U5 through C35 and C37 to provide a clock level signal. Pin 44 of the main control chip U5 is grounded through resistor R25, and pin 20 is connected to D3.3V through R26.

[0053] like Figure 6 As shown, the 232 serial port module 42 includes a 232 communication chip U7 (in this example, the model is SP3232E) and peripheral circuits, which are used to convert the TTL signal output by the main control chip U5 into a 232 signal, and then communicate with the host computer 7 through the J2 connector DB-9 interface. In the 232 serial port module 42, pin 12 of the main control chip U5 is connected to pin 10 of the chip U7 through a resistor R33, and pin 13 of the main control chip U5 is connected to pin 9 of the chip U7 through a resistor R34. J5 is a redundant 232 signal wiring port.

[0054] like Figure 7 As shown, the USB interface redundancy module 43 is designed as a redundant module to communicate the USB interface signal converted by the main control chip U5 with the host computer 7. The 232 serial port module 42 is used in normal use. When expansion is required or the 232 serial port module 42 fails, the USB interface redundancy module 43 is used to replace the communication.

[0055] J4 is a USB interface, D17 is an electrostatic surge protection tube (model NUP2201MR6), pin 32 USB_DM of the main control chip U5 is connected to pin 2 DU- of J4 through R76, and pin 33 USB_DP of the main control chip U5 is connected to pin 3 DU+ of J4 through R75. When pin 25 USB_EN of the main control chip U5 inputs a high level, transistor Q3 is turned on, and a voltage of about 2.5V is added to DU+, thereby realizing the communication between the main control chip U5 and the host computer 7.

[0056] like Figure 8 As shown, in the status indicator light module 44, pins 2 and 3 of the main control chip U5 respectively control the on and off of the light-emitting diodes D15 and D16. When LED1 outputs a high level, D15 is on; when LED2 outputs a high level, D16 is on.

[0057] like Fig. 9 As shown, in the motor enabling module 45, pin 14 Pout of the main control chip U5 is connected to pin 3 of the power load switch chip U6 (model ISP452 in this example) via resistor R20, pin 4 of chip U6 is connected to Servor_24V, C10 is a filter capacitor, D12 is an overvoltage protection diode, pin 2 of chip U6 is grounded after passing through a current limiting protection resistor R22 (preferably 150 ohms), and the output end of pin 1 of chip U6 is grounded through a varistor R23 and a ground resistor R80.

[0058] When pin 14 Pout of the main control chip U5 outputs a high level, the output voltage of pin 1 of chip U6 (motor power supply signal MOS_24V_SW) is approximately equal to Servor_24V, and the motor power supply signal MOS_24V_SW is connected to pin 4 of the J3 interface and connected to the servo motor driver 2.

[0059] like Fig.10 As shown, the relay redundancy module 46 is a redundant design of the motor enabling module 45. When the motor enabling module 45 fails, it switches to the relay redundancy module 46. In the relay redundancy module 46, the Pout signal of pin 14 of the main control chip U5 realizes the conduction and disconnection of Servor_24V and RLY_24V_SW by controlling the relay K1. When the pin 14 pout of the main control chip U5 outputs a high level, the transistor Q3 is turned on, the coil of the relay K1 is energized, and the switch of the relay K1 connects RLY_24V_SW to Servor_24V, and RLY_24V_SW is connected to pin 9 of J3 to output a 24V voltage.

[0060] like Fig.11 As shown, a total of 8 indicator light circuits are provided in the signal indicator light module 47, wherein R51 is connected in series with the light emitting diode D1 to form the indication function of the Motor_CW signal (pin 10 of the main control chip U5), R52 is connected in series with the light emitting diode D2 to form the indication function of the Motor_PWM signal (pin 11 of the main control chip U5), R53 is connected in series with the light emitting diode D3 to form the indication function of the Motor_CLR signal (pin 38 of the main control chip U5), R54 is connected in series with the light emitting diode D4 to form the indication function of the TIM1_CH1 signal (pin 12 of the main control chip U5), and R55 is connected in series with the light emitting diode D6 to form the indication function of the Motor_PWM signal (pin 13 of the main control chip U5). R55 and light-emitting diode D5 are connected in series to form the indication function of TIM1_CH1N signal (pin 26 of the main control chip U5), R56 and light-emitting diode D6 are connected in series to form the indication function of TIM4_CH1 signal (pin 42 of the main control chip U5), R57 and light-emitting diode D7 are connected in series to form the indication function of TIM4_CH2 signal (pin 43 of the main control chip U5), and R58 and light-emitting diode D8 are connected in series to form the indication function of TIM3_CH1 signal (pin 16 of the main control chip U5).

[0061] In addition, in conjunction with the 8 indicator light circuits in the signal indicator light module 47, the servo control board 4 is also provided with a test port P1 for convenient wiring to test the functions of each signal during the research and development stage. The test port P1 is respectively connected to pin No. 10 Motor_CW, pin No. 11 Motor_PWM, pin No. 38 Motor_CLR, pin No. 29 TIM1_CH1, pin No. 26 TIM1_CH1N, pin No. 42 TIM4_CH1, pin No. 43 TIM4_CH2 and pin No. 16 TIM3_CH1 of the main control chip U5.

[0062] like Fig.12 As shown, in the servo motor driver communication module 48, pins 10 Motor_CW, 11 Motor_PWM, 38 Motor_CLR, 29 TIM1_CH1, 26 TIM1_CH1N, 42 TIM4_CH1, 43 TIM4_CH2 and 16 TIM3_CH1 of the main control chip U5 are respectively connected to the signal amplifier chip U10 (ULN2803ADW is used in this example) for signal amplification processing, and the 5V voltage output of the 5V voltage conversion circuit passes through the signal PULS+ after R61 and the signal SIGN+ after R62. , the signal CLR+ after passing through R63 is connected to pins 1, 2, and 3 of J3 respectively, pin 18 Motor_CW_OUT and pin 15 TIM1_CH1_OUT of chip U10 are connected to pin 6 of J3 respectively, pin 17 Motor_PWM_OUT and pin 14 TIM1_CH1N_OUT of chip U10 are connected to pin 7 of J3 respectively, pin 16 Motor_CLR_OUT of chip U10 is connected to pin 8 of J3, RLY_24V_SW is connected to pin 9 of J3, and the motor power supply signal MOS_24V_SW is connected to pin 4 of J3.

[0063] The servo control board 4 communicates with the servo motor driver 2 through the DB-9 interface J3. Pins 1, 6, 2, 7, 4, and 5 of the DB-9 interface J3 are respectively connected to pins 7, 8, 11, 12, 47, and 40 of the servo motor driver 2CN1, so as to realize the motion control of the Yaskawa servo motor 1 through the servo motor driver 2, and then realize the precise control of the inclination sensor turntable.

[0064] Based on the circuit structure of the servo control board 4, the steps of implementing high-precision control of the tilt sensor debugging turntable motor through the servo control board 4 are as follows:

[0065] First, the upper computer 7 starts the motor angle control software and inputs the debugging angle to which the turntable needs to be controlled. After the upper computer 7 converts the angle into a control command, it sends a TTL control command signal to the 232 serial port module 42 through the J2 connector and converts it into a 232 signal and outputs it to the main control chip U5. After receiving the control command, the main control chip U5 sends a high-level signal to the power load switch chip U6 of the motor enable module 45 through the No. 14 pin Pout, so that the No. 1 pin of the power load switch chip U6 outputs a 24V voltage and provides a 24V starting power supply to the servo motor driver 2 through the DB-9 interface J3. In addition, the main control chip U5 also sends a high-level signal to the power load switch chip U6 of the motor enable module 45 through the No. 14 pin Pout. Pin No. 10 Motor_CW and pin No. 11 Motor_PWM are respectively amplified and sent to the servo motor driver 2 through the DB-9 interface J3 to control the PWM signal for controlling the speed of the servo motor and the high and low level signals for controlling the forward and reverse rotation of the servo motor. When Motor_PWM is at a high level, the servo motor rotates forward, and when Motor_PWM is at a low level, the servo motor reverses. The motor used in the inclination sensor debugging turntable of the present invention is a Yaskawa servo motor 1, and its control step angle accuracy can reach 0.001°. The servo control board 4 of the present invention can make the accuracy of the entire inclination sensor debugging turntable reach 0.03°.

[0066] In summary, the present invention realizes precise control of the Yaskawa motor of the inclination sensor test turntable through the self-designed servo control board circuit and chassis, and also reserves redundant circuits for expansion and failure prevention. In addition, a test interface is designed for easy use during testing. It has a simple structure, rich functions, low cost, and easy operation. It can meet the requirements of automated debugging by cooperating with the automatic debugging software of the host computer.

[0067] The preferred specific embodiments of the present invention are described in detail above. It should be understood that a person skilled in the art can make many modifications and changes based on the concept of the present invention without creative work. Therefore, any technical solution that can be obtained by a person skilled in the art through logical analysis, reasoning or limited experiments based on the concept of the present invention on the basis of the prior art should be within the scope of protection determined by the claims.

Claims

1. A control device for debugging a turntable motor using an inclination sensor, used to realize automatic control of the turntable motor, characterized in that: The device comprises a chassis (6) and a switching power supply (3), a servo motor driver (2), a servo control board (4) and a fan (5) installed in the chassis (6); the switching power supply (3) is connected to an external three-phase power supply (8) for power supply; the servo control board (4) communicates with a host computer (7) and controls a turntable motor through the servo motor driver (2); and the fan (5) is connected to the servo control board (4).

2. A control device for debugging a turntable motor of an inclination sensor according to claim 1, characterized in that: The case (6) is a rectangular box, and a main power switch and a power-on indicator light are provided on the outside of the front panel. The main power switch is arranged between the three-phase power supply (8) and the switch power supply (3). The servo control board (4) is fixed on the inside of the front panel. A plurality of grid holes are provided on the side panel of the case (6). The fan (5) is installed on the inside of the side panel opposite to the grid holes. A handle is provided on the top of the case (6). A square outlet hole and a circular outlet hole are provided on the rear panel of the case (6). The switch power supply (3) is installed on the servo control board (4).

3. The control device for debugging a turntable motor of an inclination sensor according to claim 1, characterized in that: The servo control board (4) comprises a power module (41), a main control chip (U5) and peripheral circuits, a 232 serial port module (42), a status indicator light module (44), a motor enable module (45), a signal indicator light module (47) and a servo motor driver communication module (48); the switch power supply (3) is powered by the power module (41); the main control chip (U5) communicates with a host computer (7) via the 232 serial port module (42); the main control chip (U5) communicates with the servo motor driver (2) via the motor enable module (45) and a DB-9 interface (J3); and the main control chip (U5) communicates with the servo motor driver (2) via the servo motor driver communication module (48) and the DB-9 interface (J3); the status indicator light module (44) and the signal indicator light module (47) are respectively connected to the main control chip (U5).

4. A control device for debugging a turntable motor of an inclination sensor according to claim 3, characterized in that: The servo control board (4) also includes a USB interface redundancy module (43). When the 232 serial port module (42) fails, the main control chip (U5) communicates with the host computer (7) via the USB interface redundancy module (43).

5. The control device for debugging a turntable motor of an inclination sensor according to claim 3, characterized in that: The servo control board (4) further comprises a relay redundancy module (46), and when the motor enabling module (45) fails, the main control chip (U5) communicates with the servo motor driver (2) via the relay redundancy module (46) and the DB-9 interface (J3).

6. The control device for debugging a turntable motor of an inclination sensor according to claim 3, characterized in that: The power supply module (41) comprises a 24V input circuit, a 6.8V voltage conversion circuit, a 5V voltage conversion circuit, a 3.3V voltage conversion circuit and a fan power supply circuit; the 24V input circuit is respectively connected to the switch power supply (3), the 6.8V voltage conversion circuit, the fan power supply circuit, the motor enable module (45) and the relay redundancy module (46); the 6.8V voltage conversion circuit is respectively connected to the 5V voltage conversion circuit and the 3.3V voltage conversion circuit; and the fan power supply circuit is connected to the fan (5).

7. The control device for debugging a turntable motor of an inclination sensor according to claim 3, characterized in that: The 232 serial port module (42) comprises a 232 communication chip (U7), the signal input end of the 232 communication chip (U7) is connected to the TTL signal output end of the main control chip (U5), and the signal output end communicates with the host computer (7) via a DB-9 connector (J2).

8. The control device for debugging a turntable motor of an inclination sensor according to claim 3, characterized in that: The motor enabling module (45) comprises a power load switch chip (U6), wherein the output end of pin 1 of the power load switch chip (U6) is grounded via a varistor and a ground resistor, pin 2 is grounded after passing through a current limiting protection resistor R22, pin 3 is connected to the signal output end Pout of the main control chip (U5) via a resistor, and pin 4 is connected to the 24V input circuit.

9. The control device for debugging a turntable motor of an inclination sensor according to claim 3, characterized in that: The servo motor driver communication module (48) comprises a signal amplifying chip (U10), and the control signal end of the main control chip (U5) is connected to the DB-9 interface (J3) after signal amplification processing by the signal amplifying chip (U10).

10. The control device for debugging a turntable motor of an inclination sensor according to claim 9, characterized in that: The steps for the control device to debug the turntable motor with the inclination sensor are as follows: The host computer (7) sends a TTL control command signal to a 232 serial port module (42) through a DB-9 connector (J2) and converts the signal into a 232 signal to a main control chip (U5); after receiving the control command, the main control chip (U5) sends a high level signal to a motor enable module (45), so that a power load switch chip (U6) outputs a 24V voltage and provides a 24V starting power supply to a servo motor driver (2) through a DB-9 interface (J3); in addition, the main control chip (U5) sends a PWM signal for controlling the motor speed and a high and low level signal for controlling the forward and reverse rotation of the motor to the servo motor driver (2) through the DB-9 interface (J3); after receiving the PWM signal and the high and low level signal, the servo motor driver (2) controls the inclination sensor debugging turntable motor to rotate to the angle required for debugging.