A force-controlled grinding method and system based on loop feedback principle
Through the force-controlled grinding method based on the principle of cyclic feedback, the distance between the grinding head and the workpiece is dynamically adjusted and the grinding force is adjusted in real time, which solves the problems of unstable quality and low efficiency in traditional grinding methods, and improves the accuracy and quality of ceramic processing.
Patent Information
- Application Number
- CN202410125295.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-01-29
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2044-01-29
AI Technical Summary
The traditional grinding method has manual grinding in ceramic processing, which leads to unstable quality, low efficiency, high cost and affects human health, and the grinding strength cannot be adjusted in real time.
Using the force-controlled grinding method based on the principle of cyclic feedback, by obtaining the difference between the expected force parameters and actual force parameters of the grinding head applied to the workpiece, dynamically adjust the distance between the grinding head and the workpiece, and adjust the grinding force in real time to keep it at a predetermined error. Within range.
It improves the accuracy and quality of polishing, realizes precise control of polishing force, reduces production costs, and improves the working environment.
Smart Images

Figure CN118143755B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of electrical control technology, and in particular to a force-controlled grinding method and system based on a loop feedback principle. Background Art
[0002] Currently in the sanitary ware industry, since ceramics are fragile items, the grinding head needs constant force to grind the ceramics. The traditional grinding method is manual grinding, and the quality of the grinding is unstable. The uniformity of the processed sanitary ceramic products is poor, and the manual operation efficiency is low, the production cost is high, and the grinding working environment has an impact on human health. Usually, in order to solve the problem of manual grinding, the robot's mechanical arm is used for control, but this does not allow the grinding force to be adjusted according to the working conditions.
[0003] In order to solve the above problems, the present application provides a force-controlled grinding method based on the loop feedback principle. Summary of the invention
[0004] The purpose of the present invention is to provide a force-controlled grinding method based on the loop feedback principle to solve the problem that the current grinding method cannot be adjusted in real time.
[0005] In order to achieve the above object, the present invention provides the following technical solutions:
[0006] The first aspect of the present application provides a force-controlled grinding method based on a loop feedback principle, comprising:
[0007] Obtaining expected force parameters and error range parameters applied by the grinding head to the workpiece during the grinding process, and measuring and obtaining actual grinding force parameters applied to the workpiece;
[0008] The absolute value of the difference between the expected force parameter and the actual grinding force parameter is obtained by using the expected force parameter and the actual grinding force parameter, and recorded as a first force difference parameter;
[0009] When the first force difference parameter is greater than the error range parameter and the expected force parameter is less than the actual grinding force parameter, the distance between the grinding head and the workpiece is reduced; when the first force difference parameter is greater than the error range parameter and the expected force parameter is greater than the actual grinding force parameter, the distance between the grinding head and the workpiece is increased.
[0010] In one embodiment, when the first force difference parameter is greater than the error range parameter and the expected force parameter is less than the actual grinding force parameter, the distance between the grinding head and the workpiece is reduced; when the first force difference parameter is greater than the error range parameter and the expected force parameter is greater than the actual grinding force parameter, the distance between the grinding head and the workpiece is increased, including:
[0011] When the first force difference parameter is greater than the error range parameter, the adjustment pulse frequency of the displacement motor is obtained through the ratio relationship between the first force difference parameter and the error range parameter; the displacement motor is used to control the distance between the grinding head and the workpiece;
[0012] When the expected force parameter is less than the actual grinding force parameter, a first adjustment pulse number of the displacement motor is obtained according to the first force difference parameter, and the displacement motor is driven according to the adjustment pulse frequency and the first adjustment pulse number, so that the displacement motor drives the grinding head to approach the workpiece;
[0013] When the expected force parameter is greater than the actual grinding force parameter, the second adjustment pulse number of the displacement motor is obtained according to the first force difference parameter, and the displacement motor is driven according to the adjustment pulse frequency and the second adjustment pulse number, so that the displacement motor drives the grinding head away from the workpiece.
[0014] In one embodiment, obtaining the adjustment pulse frequency of the displacement motor by the ratio relationship between the first force difference parameter and the error range parameter includes:
[0015] Set the speed of the displacement motor to ω x , where ω1<ω2<ω3<ω4<ω5, the first force difference parameter is ΔE, and the error range parameter is Δf. The specific corresponding relationship is as follows:
[0016] When |△E|≤2△f, the speed of the displacement motor is ω1; when 2△f<|△E|≤4△f, the speed of the displacement motor is ω2; when 4△f<|△E|≤8△f, the speed of the displacement motor is ω3; when 8△f<|△E|≤16△f, the speed of the displacement motor is ω4; when |△E|>16△f, the speed of the displacement motor is ω5;
[0017] The rotation speed of the displacement motor is proportional to the adjustment pulse frequency, satisfying:
[0018]
[0019] Among them, u is the adjustment pulse frequency; D is the subdivision coefficient of the displacement motor; q is the angle rotated by each pulse of the displacement motor.
[0020] In one embodiment, the grinding head includes a spring assembly and a grinding head, and the displacement motor is connected to the grinding head via the spring assembly;
[0021] The obtaining the first adjustment pulse quantity of the displacement motor according to the first force difference parameter includes:
[0022] The first regulating pulse quantity is obtained according to the following, and the first regulating pulse quantity satisfies:
[0023]
[0024] Among them, k is the elastic coefficient of the spring component, the first force difference parameter is ΔE, n is the number of the first adjustment pulses, and s is the length of the mechanical travel when the displacement motor rotates one circle.
[0025] In one embodiment, the displacement motor is connected to the grinding head via a spring assembly;
[0026] The obtaining the second adjustment pulse quantity of the displacement motor according to the first force difference parameter includes:
[0027] The second regulating pulse quantity is obtained according to the following, and the second regulating pulse quantity satisfies:
[0028]
[0029] Among them, k is the elastic coefficient of the spring component, the first force difference parameter is ΔE, n is the number of the second adjustment pulses, and s is the length of the mechanical travel when the displacement motor rotates one circle.
[0030] In one embodiment, the actual grinding force parameters applied to the workpiece are obtained by a dynamometer and an inclinometer.
[0031] The second aspect of the present application provides a force-controlled grinding system based on the loop feedback principle, which
[0032] It includes a robot, a CPU, a dynamometer, an inclinometer, a grinding device and a grinding head; the grinding device includes a displacement motor and a spring assembly; the robot is used to drive the grinding device to move, and the displacement motor is connected to the grinding head through the spring assembly;
[0033] The CPU obtains the expected force parameters and error range parameters applied by the grinding head to the workpiece during the grinding process, and the dynamometer and the inclinometer obtain the actual grinding force parameters applied to the workpiece by measuring the spring assembly;
[0034] The absolute value of the difference between the expected force parameter and the actual grinding force parameter is obtained by using the expected force parameter and the actual grinding force parameter, and recorded as a first force difference parameter;
[0035] When the first force difference parameter is greater than the error range parameter and the expected force parameter is less than the actual grinding force parameter, the distance between the grinding head and the workpiece is reduced; when the first force difference parameter is greater than the error range parameter and the expected force parameter is greater than the actual grinding force parameter, the distance between the grinding head and the workpiece is increased.
[0036] In one embodiment, the displacement motor is a stepping motor.
[0037] In one embodiment, the forward and reverse rotation of the displacement motor is used to control the distance between the grinding head and the workpiece.
[0038] A third aspect of the present application provides a computer-readable storage medium storing a computer program, and when the computer program is executed by a processor, the method as described in any one of the above is implemented.
[0039] Compared with the prior art, the solution of the present invention has the following advantages:
[0040] In the present invention, by presetting the expected force parameter and the error range parameter, the actual grinding force parameter applied by the grinding head to the workpiece is obtained in real time, and then the absolute value of the difference between the expected force parameter and the actual grinding force parameter is obtained to obtain a first force difference parameter. By comparing the first force difference parameter with the error range parameter, the distance between the grinding head and the workpiece is dynamically adjusted, and then the grinding force applied by the grinding head to the workpiece is dynamically adjusted, so that the grinding force acting on the workpiece can always be within the error range, thereby improving the grinding accuracy and quality. BRIEF DESCRIPTION OF THE DRAWINGS
[0041] The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the following description of the embodiments in conjunction with the accompanying drawings, in which:
[0042] Figure 1 It is a flowchart of the force-controlled grinding method based on the loop feedback principle of the present invention;
[0043] Figure 2 It is a schematic diagram of the composition of the force-controlled grinding system based on the loop feedback principle of the present invention. DETAILED DESCRIPTION
[0044] Embodiments of the present invention are described in detail below, examples of which are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are only used to explain the present invention, and cannot be interpreted as limiting the present invention.
[0045] It will be understood by those skilled in the art that, unless specifically stated, the term "comprising" used in the specification of the present invention refers to the presence of the features, integers, steps, operations, parts / components and / or assemblies, but does not exclude the presence or addition of one or more other features, integers, steps, operations, parts / components, assemblies and / or their groups. It should be understood that when we say a part / component is "connected" to another part / component, it can be directly connected to the other part / component, or there can be intermediate parts / components. The term "and / or" used herein includes all or any unit and all combinations of one or more associated listed items.
[0046] like Figure 1 As shown, the first aspect of the present application provides a force-controlled grinding method based on the loop feedback principle, including steps S100-S300.
[0047] S100, obtaining expected force parameters and error range parameters applied by the grinding head to the workpiece during the grinding process, and measuring and obtaining actual grinding force parameters applied to the workpiece.
[0048] S200, obtaining an absolute value of a difference between the expected force parameter and the actual grinding force parameter, and recording the absolute value as a first force difference parameter.
[0049] S300. When the first force difference parameter is greater than the error range parameter and the expected force parameter is less than the actual grinding force parameter, the distance between the grinding head and the workpiece is reduced; when the first force difference parameter is greater than the error range parameter and the expected force parameter is greater than the actual grinding force parameter, the distance between the grinding head and the workpiece is increased.
[0050] In this embodiment, by presetting the expected force parameter and the error range parameter, the actual grinding force parameter applied by the grinding head to the workpiece is obtained in real time, and then the absolute value of the difference between the expected force parameter and the actual grinding force parameter is obtained to obtain the first force difference parameter. By comparing the first force difference parameter with the error range parameter, the distance between the grinding head and the workpiece is dynamically adjusted, and then the grinding force applied by the grinding head to the workpiece is dynamically adjusted. Repeating the above steps will ensure that the grinding force acting on the workpiece is always within the error range, thereby improving the grinding accuracy and quality.
[0051] In one embodiment, when the first force difference parameter is greater than the error range parameter and the expected force parameter is less than the actual grinding force parameter, the distance between the grinding head and the workpiece is reduced; when the first force difference parameter is greater than the error range parameter and the expected force parameter is greater than the actual grinding force parameter, the distance between the grinding head and the workpiece is increased, including:
[0052] When the first force difference parameter is greater than the error range parameter, the adjustment pulse frequency of the displacement motor is obtained through the ratio relationship between the first force difference parameter and the error range parameter; the displacement motor is used to control the distance between the grinding head and the workpiece;
[0053] When the expected force parameter is less than the actual grinding force parameter, a first adjustment pulse number of the displacement motor is obtained according to the first force difference parameter, and the displacement motor is driven according to the adjustment pulse frequency and the first adjustment pulse number, so that the displacement motor drives the grinding head to approach the workpiece;
[0054] When the expected force parameter is greater than the actual grinding force parameter, the second adjustment pulse number of the displacement motor is obtained according to the first force difference parameter, and the displacement motor is driven according to the adjustment pulse frequency and the second adjustment pulse number, so that the displacement motor drives the grinding head away from the workpiece.
[0055] In one embodiment, obtaining the adjustment pulse frequency of the displacement motor by the ratio relationship between the first force difference parameter and the error range parameter includes:
[0056] Set the speed of the displacement motor to ω x , where ω1<ω2<ω3<ω4<ω5, the first force difference parameter is ΔE, and the error range parameter is Δf. The specific corresponding relationship is as follows:
[0057]
[0058] That is, when |△E|≤2△f, the speed of the displacement motor is ω1; when 2△f<|△E|≤4△f, the speed of the displacement motor is ω2; when 4△f<|△E|≤8△f, the speed of the displacement motor is ω3; when 8△f<|△E|≤16△f, the speed of the displacement motor is ω4; when |△E|>16△f, the speed of the displacement motor is ω5;
[0059] The rotation speed of the displacement motor is proportional to the adjustment pulse frequency, satisfying:
[0060]
[0061] Among them, u is the adjustment pulse frequency, D is the subdivision coefficient of the displacement motor; when the displacement motor is a stepper motor, the subdivision coefficient refers to the proportional coefficient of each step of the stepper motor into multiple micro-steps, and the subdivision coefficient determines the minimum controllable angle of each pulse of the stepper motor; q is the angle rotated by each pulse of the displacement motor.
[0062] In one embodiment, the grinding head includes a spring assembly and a grinding head, and the displacement motor is connected to the grinding head via the spring assembly;
[0063] The obtaining the first adjustment pulse quantity of the displacement motor according to the first force difference parameter includes:
[0064] The first regulating pulse quantity is obtained according to the following, and the first regulating pulse quantity satisfies:
[0065]
[0066] Among them, k is the elastic coefficient of the spring component, the first force difference parameter is ΔE, n is the number of the first adjustment pulses, and s is the length of the mechanical travel when the displacement motor rotates one circle.
[0067] In one embodiment, the displacement motor is connected to the grinding head via a spring assembly;
[0068] The obtaining the second adjustment pulse quantity of the displacement motor according to the first force difference parameter includes:
[0069] The second regulating pulse quantity is obtained according to the following, and the second regulating pulse quantity satisfies:
[0070]
[0071] Among them, k is the elastic coefficient of the spring component, the first force difference parameter is ΔE, n is the number of the second adjustment pulses, and s is the length of the mechanical travel when the displacement motor rotates one circle.
[0072] In one embodiment, the actual grinding force parameters applied to the workpiece are obtained by a dynamometer and an inclinometer.
[0073] The second aspect of the present application provides a force-controlled grinding system based on the loop feedback principle, which
[0074] It includes a robot, a CPU, a dynamometer, an inclinometer, a grinding device and a grinding head; the grinding device includes a displacement motor and a spring assembly; the robot is used to drive the grinding device to move, and the displacement motor is connected to the grinding head through the spring assembly;
[0075] The CPU obtains the expected force parameters and error range parameters applied by the grinding head to the workpiece during the grinding process, and the dynamometer and the inclinometer obtain the actual grinding force parameters applied to the workpiece by measuring the spring assembly;
[0076] The absolute value of the difference between the expected force parameter and the actual grinding force parameter is obtained by using the expected force parameter and the actual grinding force parameter, and recorded as a first force difference parameter;
[0077] When the first force difference parameter is greater than the error range parameter and the expected force parameter is less than the actual grinding force parameter, the distance between the grinding head and the workpiece is reduced; when the first force difference parameter is greater than the error range parameter and the expected force parameter is greater than the actual grinding force parameter, the distance between the grinding head and the workpiece is increased.
[0078] In one embodiment, the displacement motor is a stepping motor.
[0079] In one embodiment, the forward and reverse rotation of the displacement motor is used to control the distance between the grinding head and the workpiece.
[0080] Combination Figure 2 As shown, a specific example is used to illustrate the present application. There are uneven surfaces on the workbench, the deadweight of the equipment is M, the elastic coefficient of the spring assembly is 5N / mm, the original length of the spring assembly is 50mm, the lead of the screw is 8mm, the operating frequency of the stepper motor (displacement motor) is 90%, the thrust of the stepper motor is 200N, the step angle of the stepper motor is 0.9°, and the initial subdivision is 1. The allowable stroke on the screw is 15mm, with the stroke of 7.5mm as the origin, the maximum value near the grinding head stroke is recorded as +7.5mm, and the minimum value near the dynamometer is recorded as -7.5mm. The entire stroke is included in the elastic deformation of the spring assembly, and the actual grinding force cannot exceed the elastic force generated by the maximum deformation of the spring assembly when outputting. The motor moves forward and the grinding head moves to +7.5mm, and the motor moves backward and the grinding head moves to -7.5mm. The grinding device is installed at the same angle as the grinding head, and the angle between the grinding device and the vertical direction is θ, and 0≤θ≤π. The running speed of the robot connected to the grinding device is v=0.5m / s, and the equipment grinds from left to right.
[0081] Before the preparation, the whole set of grinding equipment is placed at the lower end of the workbench, and the robot adjusts the grinding position. When the robot reaches the predetermined point, it gives the force-controlled grinding system a signal to start preparation. At this time, the force-controlled grinding system is in a state where the spring assembly is retracted inward, and the grinding head will also retract as much as possible inward. At this time, the stroke of the grinding head reaches -7.5mm. When the force-controlled grinding system receives the signal to start preparation, the spring assembly is first affected by the gravity of the grinding device to produce a certain deformation. The dynamometer can obtain the force generated by the deformation of the spring assembly. This force is the component of gravity in the vertical direction of the equipment. The angle between the grinding equipment and the vertical is θ measured by the inclinometer. The CPU uses the data obtained by the inclinometer and the dynamometer to let the stepper motor drive the screw to push the spring assembly. Under the continuous feedback of the dynamometer and the adjustment of the motor, screw and spring assembly, the influence of gravity on the grinding equipment is offset. The specific form of self-weight elimination is expressed as: kΔx-Mg cosθ≥0.
[0082] Wherein, Δx is the deformation of the spring in the example; M is the measured weight of the grinding head, wherein the grinding head may also include a grinding slider; g is the acceleration of gravity; θ is the angle between the current device and gravity. The closer the self-weight elimination is to 0, the better the self-weight elimination is, and the smaller the influence of the grinding equipment on the output force during the grinding process. In a specific example, by calculation, when the self-weight elimination is 0, the stroke of the grinding head at this time is -4.6mm.
[0083] After the preparation work is completed, the expected force parameter is input as 20N through serial communication, and the error range parameter allowed for the actual grinding force is 0.2N. For the convenience of calculation, the expected speed of the displacement motor is set to 10r / s. After the deadweight is eliminated, the data obtained by the CPU through the dynamometer should be zero, and the actual grinding force of 20N must be output. Through this method, when the actual grinding force is 20±0.2N, the force-controlled grinding system gives the industrial robot a signal to start working. When the robot contacts the grinding surface (workpiece), the robot drives the grinding equipment at a speed of 0.5m / s to start grinding.
[0084] The process of how the actual grinding force changes to 20±0.2N by this method is as follows:
[0085] (1) Calculate the absolute value of the difference between the actual grinding force parameter and 20N, and record the absolute value of this difference as |ΔE|.
[0086] (2) Compare it with the allowable error of 0.2N in the actual grinding force. If the absolute value of |ΔE| in this step is greater than 0.2N, go to step (3); otherwise, end. The logical form is:
[0087]
[0088] (3): Calculate the pulse size provided by the CPU to the stepper motor at this time. The calculation formula is:
[0089]
[0090] (4): Compare the expected force parameter F0 with the actual grinding force parameter F. If F0 is less than F, the grinding head needs to move outward to increase the grinding force; otherwise, the grinding head needs to move inward.
[0091]
[0092] And according to |ΔE|, the number of pulses n provided by the CPU to the stepper motor is calculated as follows:
[0093]
[0094] (5): Repeat steps (1)-(4) until |ΔE| in step (2) is less than or equal to the input 0.2, and the expected grinding force that satisfies the error range between the expected force parameter and the actual grinding force parameter can be obtained.
[0095] After the allowable error of the grinding requirement is met, the motor stops rotating, at which time F is 20±0.2N and the stroke of the grinding head is -(0.6±0.04)mm. During the grinding process, the system of this embodiment can continuously adjust the actual output force in real time to achieve accurate and rapid control.
[0096] Step 3: End the instance job:
[0097] When the robot completes its own trajectory, it gives the force control grinding system a stop command. The grinding equipment reverses the motor until the stroke of the grinding head reaches -7.5mm.
[0098] Assume that during the grinding process, due to the unevenness of the workbench, the actual grinding force still fluctuates within the range of ±0.5N after meeting the grinding requirements. Let's discuss the case where the maximum fluctuation is 0.5N. At this time, the subdivision coefficient of the stepper motor can be changed to make the actual output force reach the predetermined force that meets the allowable error as soon as possible. Set the motor subdivision coefficient to 2, and the pulse size given by the stepper motor during the grinding process and the required number of pulses can be obtained as follows:
[0099]
[0100] In order to further describe the rapid response characteristics of the present invention, the response time of the present system is compared with the response time of a general pneumatic constant force device to obtain the following relationship:
[0101]
[0102] Wherein, t is the reaction time to generate n pulses at a frequency of u.
[0103] From the formula (10) in the example, it can be known that it takes at most 6.25ms to adjust the fluctuation of the actual output force. After consulting the data, when the error is ±0.5N, the response time of the pneumatic constant force device is about 300ms. After comparison, it is found that under the same working conditions, the response time of this system is faster than that of the pneumatic constant force device.
[0104] A third aspect of the present application provides a computer-readable storage medium storing a computer program, and when the computer program is executed by a processor, the method as described in any one of the above is implemented.
[0105] It should be noted that the information interaction, execution process, etc. between the above-mentioned devices / units are based on the same concept as the method embodiment of the present application. Their specific functions and technical effects can be found in the method embodiment part and will not be repeated here.
[0106] Those skilled in the art can clearly understand that, for the convenience and simplicity of description, only the division of the above-mentioned functional elements and circuits is used as an example for illustration. In practical applications, the above-mentioned function allocation can be completed by different functional elements and circuits as needed, that is, the internal structure of the circuit is divided into different functional elements or circuits to complete all or part of the functions described above. The functional elements and circuits in the embodiments can be integrated into a processing element, or each element can exist physically alone, or two or more elements can be integrated into one element. The above-mentioned integrated elements can be implemented in the form of hardware or in the form of software functional elements. In addition, the specific names of the functional elements and circuits are only for the convenience of distinguishing each other, and are not used to limit the scope of protection of this application. The specific working process of the elements and circuits in the above-mentioned system can refer to the corresponding process in the aforementioned method embodiment, which will not be repeated here.
[0107] References throughout the specification to "various embodiments," "in an embodiment," "one embodiment," or "an embodiment," etc., mean that a particular feature, structure, or characteristic described with respect to the embodiment is included in at least one embodiment. Therefore, the appearance of the phrases "in various embodiments," "in some embodiments," "in one embodiment," or "in an embodiment," etc., in appropriate places throughout the specification do not necessarily refer to the same embodiment. In addition, particular features, structures, or characteristics may be combined in any appropriate manner in one or more embodiments. Therefore, particular features, structures, or characteristics shown or described with respect to one embodiment may be combined in whole or in part with features, structures, or characteristics of one or more other embodiments without assuming that such a combination is not an illogical or non-functional limitation.
[0108] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described or recorded in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.
[0109] Those of ordinary skill in the art will appreciate that the elements and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.
[0110] In the embodiments provided by the present invention, it should be understood that the disclosed circuits / terminal devices and methods can be implemented in other ways. For example, the circuit / terminal device embodiments described above are only schematic. For example, the division of the circuits or components is only a logical function division. There may be other division methods in actual implementation, such as multiple components or circuits can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of circuits or components, which can be electrical, mechanical or other forms.
[0111] The components described as separate components may or may not be physically separated, and the components shown as components may or may not be physical components, that is, they may be located in one place or distributed on multiple network components. Some or all of the components may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0112] In addition, each functional element in each embodiment of the present invention may be integrated into one processing element, or each element may exist physically separately, or two or more elements may be integrated into one element. The above-mentioned integrated element may be implemented in the form of hardware or in the form of software functional elements.
[0113] An embodiment of the present application further provides a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps in the above-mentioned method embodiments can be implemented.
[0114] If the integrated circuit / component is implemented in the form of a software functional element and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the present invention implements all or part of the processes in the above-mentioned embodiment method, and can also be completed by instructing the relevant hardware through a computer program. The computer program can be stored in a computer-readable storage medium, and the computer program can implement the steps of the above-mentioned various method embodiments when executed by the processor. Among them, the computer program includes computer program code, and the computer program code can be in source code form, object code form, executable file or some intermediate form. The computer-readable medium may include: any entity or circuit that can carry the computer program code, recording medium, U disk, mobile hard disk, disk, optical disk, computer memory, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), electric carrier signal, telecommunication signal and software distribution medium. It should be noted that the content contained in the computer-readable medium can be appropriately increased or decreased according to the requirements of legislation and patent practice in the jurisdiction. For example, in some jurisdictions, according to legislation and patent practice, computer-readable media do not include electric carrier signals and telecommunication signals.
[0115] The above descriptions are only some embodiments of the present invention. It should be pointed out that, for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.
Claims
1. A force-controlled grinding method based on the principle of loop feedback, characterized in that: include: Obtaining expected force parameters and error range parameters applied by the grinding head to the workpiece during the grinding process, and measuring and obtaining actual grinding force parameters applied to the workpiece; The absolute value of the difference between the expected force parameter and the actual grinding force parameter is obtained by the first force difference parameter; when the first force difference parameter is greater than the error range parameter and the expected force parameter is less than the actual grinding force parameter, the distance between the grinding head and the workpiece is increased; when the first force difference parameter is greater than the error range parameter and the expected force parameter is greater than the actual grinding force parameter, the distance between the grinding head and the workpiece is decreased; When the first force difference parameter is greater than the error range parameter and the expected force parameter is less than the actual grinding force parameter, increasing the distance between the grinding head and the workpiece; When the first force difference parameter is greater than the error range parameter, and the expected force parameter is greater than the actual grinding force parameter, reducing the distance between the grinding head and the workpiece includes: When the first force difference parameter is greater than the error range parameter, the adjustment pulse frequency of the displacement motor is obtained through the ratio relationship between the first force difference parameter and the error range parameter; the displacement motor is used to control the distance between the grinding head and the workpiece; When the expected force parameter is less than the actual grinding force parameter, a first adjustment pulse number of the displacement motor is obtained according to the first force difference parameter, and the displacement motor is driven according to the adjustment pulse frequency and the first adjustment pulse number, so that the displacement motor drives the grinding head away from the workpiece; When the expected force parameter is greater than the actual grinding force parameter, a second adjustment pulse number of the displacement motor is obtained according to the first force difference parameter, and the displacement motor is driven according to the adjustment pulse frequency and the second adjustment pulse number, so that the displacement motor drives the grinding head to approach the workpiece; The step of obtaining the adjustment pulse frequency of the displacement motor by the ratio relationship between the first force difference parameter and the error range parameter includes: Set the speed of the displacement motor to ω x ,in , the first force difference parameter is , the error range parameter is , the specific corresponding relationship is as follows: When |△E|≤2△f, the speed of the displacement motor is ; When 2△f<|△E|≤4△f, the speed of the displacement motor is ; When 4△f<|△E|≤8△f, the speed of the displacement motor is ; When 8△f<|△E|≤16△f, the speed of the displacement motor is ; When |△E|>16△f, the speed of the displacement motor is ; The rotation speed of the displacement motor is proportional to the adjustment pulse frequency, satisfying: ;in, is the regulating pulse frequency; D is the subdivision coefficient of the displacement motor; q is the angle rotated by each pulse of the displacement motor; The grinding head comprises a spring assembly and a grinding head, and the displacement motor is connected to the grinding head via the spring assembly; The obtaining the first adjustment pulse quantity of the displacement motor according to the first force difference parameter includes: The first regulating pulse quantity is obtained according to the following, and the first regulating pulse quantity satisfies: ;in, is the elastic coefficient of the spring assembly, and the first force difference parameter is , is the number of the first regulating pulses, and s is the length of the mechanical travel of one rotation of the displacement motor; The displacement motor is connected to the grinding head via a spring assembly; The obtaining the second adjustment pulse quantity of the displacement motor according to the first force difference parameter includes: The second regulating pulse quantity is obtained according to the following, and the second regulating pulse quantity satisfies: ;in, is the elastic coefficient of the spring assembly, and the first force difference parameter is , is the number of the second adjustment pulses, and s is the length of the mechanical travel when the displacement motor rotates one circle.
2. The method according to claim 1, characterized in that The actual grinding force parameters applied to the workpiece are obtained by a dynamometer and an inclinometer.
3. A force-controlled grinding system based on the principle of loop feedback, characterized in that: Apply the method as claimed in claim 1, It includes a robot, a CPU, a dynamometer, an inclinometer, a grinding device and a grinding head; the grinding device includes a displacement motor and a spring assembly; the robot is used to drive the grinding device to move, and the displacement motor is connected to the grinding head through the spring assembly; The CPU obtains the expected force parameters and error range parameters applied by the grinding head to the workpiece during the grinding process, and the dynamometer and the inclinometer obtain the actual grinding force parameters applied to the workpiece by measuring the spring assembly; The absolute value of the difference between the expected force parameter and the actual grinding force parameter is obtained by using the expected force parameter and the actual grinding force parameter, and recorded as a first force difference parameter; When the first force difference parameter is greater than the error range parameter and the expected force parameter is less than the actual grinding force parameter, the distance between the grinding head and the workpiece is increased; when the first force difference parameter is greater than the error range parameter and the expected force parameter is greater than the actual grinding force parameter, the distance between the grinding head and the workpiece is reduced.
4. The system according to claim 3, characterized in that The displacement motor is a stepping motor.
5. The system according to claim 3, characterized in that The forward and reverse rotation of the displacement motor is used to control the distance between the grinding head and the workpiece.
6. A computer-readable storage medium storing a computer program, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the method according to any one of claims 1 and 2 is implemented.
