Servo control apparatus that performs learning control by changing reference axis
10962952 ยท 2021-03-30
Assignee
Inventors
Cpc classification
G05B19/402
PHYSICS
G05B19/19
PHYSICS
G05B2219/50216
PHYSICS
International classification
G05B19/402
PHYSICS
Abstract
A servo control apparatus for a machine that performs machining by causing a plurality of synchronizing axes to operate cooperatively in synchronized relationship with a reference axis, the servo control apparatus comprising: a position detection unit for detecting at least one of the position of the servo motor and the position of a driven body; a position error calculation unit for calculating an error between the position command and the position detected by the position detection unit; a reference axis position acquisition unit for acquiring the positions of a plurality of reference axes; a reference axis selection unit for selecting one reference axis based on a machining condition of the driven body from among the plurality of reference axes whose positions have been acquired; and a learning control unit for performing learning control using an angle synchronization method, based on the error and the position of the selected reference axis.
Claims
1. A servo control apparatus for a machine that performs machining by driving and controlling a servomotor on the basis of a position command and by causing a plurality of synchronizing axes to operate cooperatively in synchronized relationship with a plurality of reference axes, the servo control apparatus comprising: a processor to perform the following steps: calculating a position error between the position command and a detected position of the servomotor; acquiring positions of a plurality of reference axes; selecting one reference axis on the basis of a machining condition of a driven body from among the plurality of reference axes whose positions have been acquired, a machine condition is acquired by using a workpiece changing signal; and a plurality of learning control processors for performing learning control using an angle synchronization method, on the basis of the position error and the position of the selected reference axis, wherein the plurality of learning control processors performs the following steps: sampling the position error at a predetermined sampling frequency; converting the position error from time reference to position reference; filtering the converted position error; storing the filtered position error in a delay memory; converting the position error stored in the delay memory from position reference to time reference; and outputting the position error as correction value, wherein the plurality of learning control processors is changed in synchronized fashion when the reference axis is changed by selecting a different one of the plurality of reference axes from the reference axis previously selected, and wherein the plurality of learning control processors correspond to the plurality of reference axes.
2. The servo control apparatus according to claim 1, wherein the machining condition is acquired either from the machine or from a host control apparatus.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) The above and other objects, features, and advantages of the present invention will become more apparent from the description of the preferred embodiments as set forth below with reference to the accompanying drawings, wherein:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
DETAILED DESCRIPTION
(13) Servo control apparatus according to the present invention will be described below with reference to the accompanying drawings.
First Embodiment
(14) A description will be given of a servo control apparatus according to a first embodiment of the present invention.
(15) Next, the operation of the servo control apparatus according to the first embodiment of the present invention will be described. First, the position command is input to the servo control apparatus 101 from a host control apparatus 20 such as a numerical control apparatus. The position detection unit 2 is located near the servo motor 30, and detects the position of the servo motor 30. The position of the driven body being driven by the servo motor 30 can be determined based on the position of the servo motor 30.
(16) The position command supplied from the host control apparatus 20 and the detected position fed back from the position detection unit 2 are input to the position error calculation unit 4 which calculates the position error by subtracting the detected position from the position command.
(17) The position error thus calculated is supplied to a position control unit 12 and thence to the learning control unit 10. In the learning control unit 10, learning control is performed, as will be described later, based on the reference axis selected by the reference axis selection unit 8 based on the positions of the reference axes acquired by the reference axis position acquisition unit 6. The servo control apparatus of the present invention employs the angle synchronization method, and acquires angle (position) information from the reference axis. The acquisition of the position is accomplished by the reference axis sending the position command value or position feedback value of the reference axis to the synchronizing axis. This is executed when the learning control is initiated. More particularly, when the reference axis and the synchronizing axis are under the control of the same DSP (Digital Signal Processor, the CPU for controlling the servo axis), the position can be directly acquired. More than one axis can be assigned to one DSP, but if the respective axes are assigned to different DSPs, the position is acquired in most cases by transmitting and receiving data through communications between the DSPs. Alternatively, it is also possible to transfer position data via the host control apparatus 20 shown in
(18) The learning control unit 10 calculates the amount of correction through learning control, and supplies the amount of correction thus calculated to the position control unit 12. Based on the amount of correction calculated by the learning control unit 10, the position control unit 12 corrects the position error, and computes a velocity command by multiplying the corrected position error by a position gain.
(19) A velocity control unit 14 computes a current command based on a velocity error which represents the difference between the obtained velocity command and the velocity fed back from a velocity detector (not shown) provided to detect the velocity of the servo motor 30 or the velocity of the driven body.
(20) A current control unit 16 calculates a drive voltage based on the obtained current command and the current value fed back from a current detector (not shown) provided in an amplifier 18. The amplifier 18 drives the servo motor 30 in accordance with the calculated drive voltage.
(21)
(22)
(23) Next, the sequence of operations performed by the servo control apparatus according to the first embodiment of the present invention will be described with reference to the flowchart illustrated in
(24) Then, in step S102, the positions of the plurality of reference axes are acquired. In step S103, the machining condition is acquired either from the machine or from the host control apparatus. More specifically, the servo control apparatus 101 may acquire the machining condition directly from the machine or may acquire the machining condition from the host control apparatus 20.
(25) Next, in step S104, one of the plurality of reference axes is selected according to the machining condition. More specifically, from among the plurality of reference axes whose positions have been acquired, the reference axis selection unit 8 selects one reference axis based on the machining condition of the driven body.
(26) Next, in step S105, based on the error and the position of the reference axis, learning control is performed using the learning control unit. More specifically, the learning control unit 10 performs learning control using the angle synchronization method, based on the error and the position of the selected reference axis.
(27) As has been described above, according to the servo control apparatus of the first embodiment of the present invention, an appropriate reference axis can be selected according to the machining condition, making it possible to perform effective learning control that matches the machining process. As a result, highly precise machining can be achieved.
Second Embodiment
(28) Next, a description will be given of a servo control apparatus according to a second embodiment of the present invention.
(29)
(30) Next, the sequence of operations performed by the servo control apparatus according to the second embodiment of the present invention will be described with reference to the flowchart of
(31) Then, in step S202, the positions of the plurality of reference axes are acquired. In step S203, the machining condition is acquired either from the machine or from the host control apparatus. More specifically, the servo control apparatus 102 may acquire the machining condition directly from the machine or may acquire the machining condition from the host control apparatus 20.
(32) Next, in step S204, one of the plurality of reference axes is selected according to the machining condition. More specifically, from among the plurality of reference axes whose positions have been acquired, the reference axis selection unit 8 selects one reference axis based on the machining condition of the driven body.
(33) Further, in step S205, one of the plurality of learning controllers is selected according to the machining condition. More specifically, from among the plurality of learning controllers (first learning controller 10-1, second learning controller 10-2, . . . , nth learning controller 10-n), the learning controller selection unit 11 selects one learning controller based on the machining condition of the workpiece.
(34) Next, in step S206, based on the error and the position of the reference axis, learning control is performed using the learning control unit. More specifically, the learning control unit performs learning control using the angle synchronization method, based on the error and the position of the selected reference axis. The machining condition is acquired either directly by means of a signal or the like or from the host control apparatus 20, and is used to determine whether the reference axis is to be changed or not.
(35) As has been described above, according to the servo control apparatus of the second embodiment of the present invention, since the learning controller is changed synchronously with the changing of the reference axis, it becomes possible to hold the amount of correction generated for each machining process. This serves to reduce the time taken between the initiation of learning and the generation of correction data, serving to improve the productivity.
(36) According to the servo control apparatus of the embodiment of the present invention, an appropriate reference axis can be selected according to the machining condition, making it possible to perform effective learning control that matches the machining process. As a result, highly precise machining can be achieved.