Coefficient calibration method, device, equipment and medium applied to trowel robot
By adjusting the offset angle and speed of the wiping disc according to the ground friction coefficient, the calibration coefficient of the wiping robot is automatically determined, which solves the problem that human adjustments are difficult to adapt to ground changes, and improves the operation quality and adaptability of the wiping robot.
Patent Information
- Application Number
- CN202111128122.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-09-26
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2041-09-26
AI Technical Summary
The existing control strategies of wiping robots rely on manpower adjustments, making it difficult to dynamically adapt to changes in ground materials, temperature and humidity, resulting in a decline in operation quality.
By determining the first offset angle set and the second offset angle set of the wiping disc based on the ground friction coefficient, controlling the wiping disc rotation operation to obtain the target angular velocity and linear velocity values, and automatically adjusting the calibration coefficient of the wiping robot, including the angular velocity and linear velocity, the wiping robot is used to automatically adjust the wiping robot's calibration coefficient, including the angular velocity and linear velocity. Control parameters.
The dynamic adjustment of the control coefficient of the wiping robot is realized, the operation quality is improved, the demand for manual on-site calibration is reduced, and the adaptability to various working conditions is enhanced.
Smart Images

Figure CN115870965B_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present invention relate to the field of intelligent robots, and in particular to a coefficient calibration method, device, electronic equipment and medium applied to a finishing robot. Background Art
[0002] With the development of intelligence, trowel machines can be used in the construction industry to smooth the ground.
[0003] At present, the control strategy adopted for trowel machines is mostly manual control. When using the above method for control, there are certain problems. For example, when using manual control, the user needs to adjust the control coefficient in the trowel machine on site, and the adjustment of the control coefficient requires professional personnel to operate, so there is a technical problem of inconvenience in use. Thirdly, in the specific operation process, the trowel machine is greatly affected by the ground material, temperature, humidity and hardness, and the ground on site will solidify over time. Correspondingly, the ground humidity will also change accordingly. Therefore, it is necessary to dynamically adjust the control coefficient for different situations. At this time, the difficulty of adjusting the coefficient is increased. Finally, if the leveling operation is performed based on the original set control coefficient, the corresponding effect may not be achieved, resulting in the problem of reduced operation quality. Summary of the invention
[0004] The present invention provides a coefficient calibration method, device, equipment and medium applied to a trowel robot, so as to realize the technical effect of automatically and dynamically adjusting the control coefficient in the trowel robot, thereby improving the operation quality.
[0005] In a first aspect, an embodiment of the present invention provides a coefficient calibration method applied to a trowel robot, the method comprising:
[0006] Determine a first offset angle set and a second offset angle set corresponding to the wiper according to the ground friction coefficient, wherein the first offset angle set includes at least one first offset angle, and the second offset angle set includes at least one second offset angle, and the first offset angle and the second offset angle are angles between the wiper and a horizontal plane;
[0007] Controlling the wiper disk to perform a rotation operation based on the first offset angle, and obtaining at least one target angular velocity value corresponding to the first offset angle set during stable rotation; controlling the wiper disk to perform a rotation operation based on the second offset angle, and obtaining at least one target linear velocity value corresponding to the second offset angle set during stable rotation;
[0008] If the at least one target angular velocity value is within the corresponding preset angular velocity range, and the at least one target linear velocity value is within the corresponding preset linear velocity range, then the calibration coefficient of the finishing robot is determined according to the first offset angle set, the second offset angle set, the at least one target angular velocity value and the at least one target linear velocity value, so as to control the operation of the finishing robot based on the calibration coefficient; wherein the calibration coefficient includes an angular velocity control parameter, an angle loop control coefficient and a linear velocity control coefficient.
[0009] In a second aspect, an embodiment of the present invention further provides a coefficient calibration device applied to a trowel robot, the device comprising:
[0010] an offset angle determination module, for determining a first offset angle set and a second offset angle set corresponding to the wiper according to a ground friction coefficient, wherein the first offset angle set includes at least one first offset angle, the second offset angle set includes at least one second offset angle, and the first offset angle and the second offset angle are angles between the wiper and a horizontal plane;
[0011] a wiper disk rotation operation control module, configured to control the wiper disk to perform a rotation operation based on the first offset angle, and obtain at least one target angular velocity value corresponding to the first offset angle set during stable rotation, and to control the wiper disk to perform a rotation operation based on the second offset angle, and obtain at least one target linear velocity value corresponding to the second offset angle set during stable rotation;
[0012] A calibration coefficient determination module is used to determine the calibration coefficient of the finishing robot according to the first offset angle set, the second offset angle set, the at least one target angular velocity value and the at least one target linear velocity value if the at least one target angular velocity value is within the corresponding preset angular velocity range and the at least one target linear velocity value is within the corresponding preset linear velocity range, so as to control the operation of the finishing robot based on the calibration coefficient; wherein the calibration coefficient includes an angular velocity control parameter, an angle loop control coefficient and a linear velocity control coefficient.
[0013] In a third aspect, an embodiment of the present invention further provides an electronic device, the electronic device comprising:
[0014] one or more processors;
[0015] a storage device for storing one or more programs,
[0016] When the one or more programs are executed by the one or more processors, the one or more processors implement the coefficient calibration method applied to a finishing robot as described in any one of the embodiments of the present invention.
[0017] In a fourth aspect, an embodiment of the present invention further provides a storage medium comprising computer executable instructions, which, when executed by a computer processor, are used to execute a coefficient calibration method for a finishing robot as described in any one of the embodiments of the present invention.
[0018] The technical solution of the embodiment of the present invention can determine a first offset angle set and a second offset angle set relative to the wiping disc according to the ground friction coefficient, and then control the wiping disc to perform a rotation operation based on each offset angle in the set. When the wiping disc rotates stably, at least one target angular velocity value corresponding to the first offset angle set and at least one target linear velocity value corresponding to the second offset angle set are obtained. When the obtained target angular velocity value and target linear velocity value are within a preset speed range, the calibration coefficient of the trowel robot can be automatically determined, and there is no need to perform on-site calibration manually. This realizes the technical effect of automatically and dynamically adjusting the control coefficient in the trowel robot and improving the operation quality of the trowel robot. BRIEF DESCRIPTION OF THE DRAWINGS
[0019] In order to more clearly illustrate the technical solutions of the exemplary embodiments of the present invention, the following briefly introduces the drawings required to describe the embodiments. Obviously, the drawings introduced are only drawings of a part of the embodiments to be described in the present invention, rather than all the drawings. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0020] Figure 1 A schematic flow chart of a coefficient calibration method applied to a trowel robot provided in the first embodiment of the present invention;
[0021] Figure 2 This is a schematic diagram of the structure of the trowel robot provided in the first embodiment of the present invention;
[0022] Figure 3 A schematic diagram of the structure of a wiper provided in Embodiment 1 of the present invention;
[0023] Figure 4 A schematic flow chart of a coefficient calibration method applied to a trowel robot provided in the second embodiment of the present invention;
[0024] Figure 5 A flow chart of angular velocity coefficient calibration of a trowel robot provided in the second embodiment of the present invention;
[0025] Figure 6 A flow chart of the linear velocity coefficient calibration of a trowel robot provided in the second embodiment of the present invention;
[0026] Figure 7A schematic flow chart of a coefficient calibration method applied to a trowel robot provided in the third embodiment of the present invention;
[0027] Figure 8 This is a structural block diagram of a coefficient calibration device applied to a trowel robot provided in a fifth embodiment of the present invention;
[0028] Fig. 9 This is a structural schematic diagram of an electronic device provided in Embodiment 6 of the present invention. DETAILED DESCRIPTION
[0029] The present invention will be further described in detail below in conjunction with the accompanying drawings and embodiments. It is to be understood that the specific embodiments described herein are only used to explain the present invention, rather than to limit the present invention. It should also be noted that, for ease of description, only parts related to the present invention, rather than all structures, are shown in the accompanying drawings.
[0030] Embodiment 1
[0031] Figure 1 This is a flow chart of a coefficient calibration method applied to a finishing robot provided in Example 1 of the present invention. This embodiment is applicable to the situation of on-site calibration of the control coefficients of the finishing robot in an automated manner. The method can be executed by a coefficient calibration device applied to the finishing robot. The device can be implemented in the form of software and / or hardware. The hardware can be an electronic device, such as a mobile terminal, a PC or a server.
[0032] Before further describing the present invention in detail, the nouns and terms involved in the embodiments of the present invention are explained. The polishing robot and the polishing plate involved in the embodiments of the present invention are applicable to the following explanations:
[0033] 1) Polishing robot: also known as finishing robot, is a kind of intelligent robot used in the construction industry. As a mobile device integrating automation technology, the polishing robot can automatically complete the polishing work on the ground that has been coated with concrete, cement or other materials with certain artificial intelligence technology. Figure 2 From the structural diagram of the trowel robot with two trowel discs, it can be seen that the trowel disc 1 is an important component of the trowel robot. The turntable is connected to the body of the trowel robot 3 based on a specific connection mechanism 2, and forms certain angles θ1 and θ2 with the horizontal plane.
[0034] 2) Scraper: A device installed on the trowel robot, usually a cross structure equipped with a spatula, driven by a motor. When the trowel rotates, it can smooth the concrete, cement and other materials on the ground. In order to adapt to different ground surfaces, the distance between the trowel and the ground, the angle, and the rotation speed of the spatula can be adjusted according to actual conditions. It can be understood that one or more trowels can be installed on the trowel robot, and the specific number should be selected according to actual conditions. Figure 3 It can be seen that the two trowel discs on the trowel robot can rotate in clockwise and counterclockwise directions respectively, and at the same time, they are attached to the trowel robot to move on the work site to perform trowel operations on various locations on the site.
[0035] like Figure 1 As shown, the method specifically comprises the following steps:
[0036] S110. Determine a first offset angle set and a second offset angle set corresponding to the wiper according to the ground friction coefficient.
[0037] The ground friction coefficient can be the ratio of the friction between the trowel and the ground to the vertical force acting on one of the surfaces. It is related to the roughness of the ground and the size of the contact surface, and is a dynamic friction coefficient. For example, when the trowel robot performs a troweling task at a construction site, it can determine the ground friction coefficient corresponding to the current ground. When the materials applied on the ground are different (such as a concrete ground and a hydraulic ground), the determined ground friction coefficient is also different.
[0038] The relevant parameters of the wiping disc on the finishing robot can be adjusted dynamically. For example, the distance between the turntable and the ground, the turntable speed and the angle between the turntable and the ground can be adjusted. Based on this, in this embodiment, the offset angle is the angle between the wiping disc and the horizontal plane, which is obtained according to the ground friction coefficient. It can be understood that the offset angle of the wiping disc corresponding to different ground friction coefficients is also different.
[0039] In this embodiment, the first offset angle set and the second offset angle set can be determined according to the ground friction coefficient. Among them, the first offset angle set includes at least one first offset angle, and the second offset angle set includes at least one second offset angle. The first offset angle is used to calibrate the control coefficient related to the posture of the trowel robot, and the second offset angle is used to calibrate the control coefficient related to the running speed of the trowel robot. It should be noted that for the trowel robot, the first offset angle set and the second offset angle set are determined separately. When the first offset angle set is determined, according to each of the first offset angles, the trowel robot can reach the corresponding target angular velocity value and run stably; when the second offset angle set is determined, according to each of the second offset angles, the trowel robot can reach the corresponding target linear velocity value and perform linear motion.
[0040] In this embodiment, a corresponding experience table is provided for the trowel robot. The experience table records the multiple groups of offset angles corresponding to the trowel plate when the trowel robot of this model works normally on different types of ground (corresponding ground friction coefficients are marked for each ground). It can be understood that the content in the experience table represents the corresponding relationship between the ground friction coefficient and the multiple groups of offset angles. Therefore, after the ground friction coefficient is determined, the first offset angle set and the second offset angle set corresponding to the current opposite friction coefficient can be determined from the experience table. In other words, based on the ground friction coefficient, the current ground type can be determined, and the first offset angle set and the second offset angle set corresponding to the current ground type can be determined.
[0041] S120, controlling the wiper disk to perform a rotation operation based on the first offset angle, and obtaining at least one target angular velocity value corresponding to the first offset angle set during stable rotation, and controlling the wiper disk to perform a rotation operation based on the second offset angle, and obtaining at least one target linear velocity value corresponding to the second offset angle set during stable rotation.
[0042] In this embodiment, after the offset angle of the wiping disc is determined, the turntable is rotated, and after a certain period of time, the wiping disc can reach a stable rotation state on the current ground. When the wiping disc is in a stable state, the target angular velocity value corresponding to the current first offset angle and the target linear velocity value corresponding to the current second offset angle can be determined by using a sensor or detection device installed on the trowel robot.
[0043] Among them, the target angular velocity value corresponding to the first offset angle and the target linear velocity value corresponding to the second offset angle can be unified as the speed-related value of each offset angle. Specifically, the speed-related value is the relevant parameter characterizing the position and movement speed of the trowel robot. It can be understood that the target angular velocity value is the angular velocity value corresponding to the trowel robot when it is in a stable state, and the target linear velocity value is the movement speed corresponding to the trowel robot when it is in a stable state.
[0044] In the actual application process, in order to improve the accuracy of the coefficient calibration of the finishing robot, at least three speed-related values need to be determined for each offset angle set. It should be noted that each speed-related value is determined based on the corresponding offset angle, so there are at least three offset angles in each offset angle set. Multiple offset angles can be selected from an empirical table, or the difference between the offset angles can be pre-set. Once an offset angle is determined, multiple offset angles can be adaptively determined; at the same time, the finishing robot operates independently according to each first offset angle and each second offset angle, and determines the corresponding speed-related values respectively.
[0045] In order to clearly introduce the process of determining at least three speed association values according to each offset angle set, the first offset angle set is used as an example for explanation. The first offset angle set includes three first offset angles θ1, θ2, and θ3. When the current first offset angle set for the trowel robot is θ1 (that is, the angle between the trowel plate and the horizontal plane is θ1), the trowel plate can be started to rotate. When the trowel robot driven by the trowel plate reaches a stable operation state, the current angular speed value ω1 of the trowel robot can be determined according to the sensor or detection device on the body. It can be understood that ω1 is the speed association value corresponding to θ1. After determining a speed association value for the first offset angle set, two other first offset angles θ2 and θ3 are set for the trowel robot, and the corresponding angular speed values ω2 and ω3 are determined in turn, that is, three speed association values corresponding to the first offset angle set are obtained. For the second offset angle set, unlike the first offset angle, the speed association value corresponding to the second offset angle is the linear speed value that characterizes the running speed of the finishing robot, rather than the angular speed value of the finishing robot. It can be understood that the finishing robot can reach a stable straight line running state according to a second offset speed. The specific process of determining the linear speed value of the finishing robot according to the second offset speed is similar to the above steps and will not be repeated here.
[0046] S130. If at least one target angular velocity value is within the corresponding preset angular velocity range, and at least one target linear velocity value is within the corresponding preset linear velocity range, a calibration coefficient of the finishing robot is determined according to the first offset angle set, the second offset angle set, the at least one target angular velocity value, and the at least one target linear velocity value, so as to control the operation of the finishing robot based on the calibration coefficient.
[0047] Among them, for the speed correlation value of the wiping plate at each offset angle, the corresponding speed range can be preset. It can be understood that for different speed correlation values, the corresponding preset speed range is also different. For example, when the trowel robot is used on site, the first offset angle set of the trowel plate includes three first offset angles, which are 10°, 15°, and 20°. For the above three first offset angles, the corresponding angular velocity ranges pre-set for the trowel robot are 5-15rad / s, 15-25rad / s, and 25-35rad / s, respectively. When the target angular velocity values reached by the trowel robot in the three stable rotation states are 10rad / s, 20rad / s, and 30rad / s, respectively, it can be determined that the three speed correlation values are all within the corresponding preset angular velocity ranges.
[0048] It should be noted that when the wiping disc of the finishing robot reaches stability at a certain offset angle, if the determined speed correlation value cannot be within the preset speed range, the offset angle of the wiping disc needs to be further adjusted to execute the subsequent steps of the plan.
[0049] Furthermore, after determining each offset angle set and its corresponding at least three speed-related values, the calibration coefficient of the trowel robot can be obtained according to the determined information. Among them, the calibration coefficient includes an angular velocity control parameter, an angle loop control coefficient and a linear velocity control coefficient. When the trowel robot is performing a troweling task, the angular velocity control parameter can be combined with the angle loop control coefficient to adjust the position and posture of the trowel robot. It can be understood that a three-dimensional space coordinate system is pre-constructed at the work site. Based on the angular velocity control parameter and the angle loop control coefficient, the position and posture information of the trowel robot in the three-dimensional space coordinate system can be determined in real time; the linear velocity control coefficient is used to adjust the running speed of the trowel robot at the work site.
[0050] The technical solution of the present embodiment can determine a first offset angle set and a second offset angle set relative to the trowel plate according to the ground friction coefficient, and then control the trowel plate to perform a rotation operation based on each offset angle in the set. When the trowel plate rotates stably, at least one target angular velocity value corresponding to the first offset angle set and at least one target linear velocity value corresponding to the second offset angle set are obtained. When the obtained target angular velocity value and target linear velocity value are within a preset speed range, the calibration coefficient of the trowel robot can be automatically determined, and there is no need for manual on-site calibration. This realizes the technical effect of automatically and dynamically adjusting the control coefficient in the trowel robot and improving the operation quality of the trowel robot.
[0051] Embodiment 2
[0052] Figure 4 The flowchart of a coefficient calibration method applied to a trowel robot provided in the second embodiment of the present invention is as follows. On the basis of the above-mentioned embodiment, the ground friction coefficient is determined according to the trowel load rate, and the calibration coefficient of the trowel robot is determined according to each offset angle set, at least three speed association values corresponding to each offset angle set, and the trowel rotation speed of the trowel, thereby further improving the intelligence level of the trowel robot; when each speed association value is not within the corresponding preset speed range, the offset angle can be adjusted once or multiple times based on the preset superposition angle until the speed association value meets the requirements of the work site, thereby enhancing the adaptability of the trowel robot to various working conditions. The specific implementation method can refer to the technical solution of this embodiment. Among them, the technical terms that are the same as or corresponding to the above-mentioned embodiments are not repeated here.
[0053] like Figure 4 As shown, the method specifically comprises the following steps:
[0054] S210, after adjusting the angle between the wiper plate and the horizontal plane to a preset angle, rotate the wiper plate; obtain the load rate of the wiper plate, and determine the ground friction coefficient of the ground according to the load rate.
[0055] In the process of determining the floor friction coefficient, it is necessary to pre-adjust the angle between the wiper and the horizontal plane. In order to make the determined floor friction coefficient as accurate as possible, preferably, the preset angle is 0°. After the angle between the wiper and the horizontal plane is adjusted to the preset angle, the motor connected to the wiper can be started to rotate the wiper.
[0056] Furthermore, during the rotation of the wiper, the load rate of the motor can be read by a sensor or detection device installed on the trowel robot, that is, the ratio of the average load of the wiper motor to the maximum load can be determined. Based on a pre-stored mapping table that characterizes the relationship between the motor load rate and the ground friction coefficient, the ground friction coefficient of the current ground can be determined. It can be understood that for the wiper, the greater the load rate, the greater the friction force, and at the same time, the ground friction coefficient determined according to the mapping table is also greater.
[0057] It should be noted that, in this embodiment, the mapping table characterizing the relationship between the motor load rate and the ground friction coefficient may be an empirical table, in which the range of the motor load rate when this model of finishing robot is working normally on different types of ground (each ground is marked with the corresponding ground friction coefficient) is recorded. Therefore, after reading the motor load rate, the ground friction coefficient of the corresponding type of ground can be determined.
[0058] S220. Determine a first offset angle set and a second offset angle set corresponding to the wiper according to the ground friction coefficient.
[0059] S230, controlling the wiper disk to perform a rotation operation based on the first offset angle, and obtaining at least one target angular velocity value corresponding to the first offset angle set during stable rotation, and controlling the wiper disk to perform a rotation operation based on the second offset angle, and obtaining at least one target linear velocity value corresponding to the second offset angle set during stable rotation.
[0060] The first offset angle set includes at least two first offset angles, specifically, the first offset angle set includes the minimum first offset angle and the maximum first offset angle; correspondingly, the second offset angle set also includes at least two second offset angles, specifically, the second offset angle set includes the minimum second offset angle and the maximum second offset angle. That is to say, on the current ground, for the first offset angle related to the position information of the trowel robot and the second offset angle related to the movement speed of the trowel robot, the minimum angle and the maximum angle between the trowel plate and the horizontal plane can be determined respectively.
[0061] It should be noted that, since the first offset angle set includes at least two first offset angles and the second offset angle set includes at least two second offset angles, at least one target angular velocity value determined in the subsequent process corresponds to a first offset angle, and at least one target linear velocity value determined corresponds to a second offset angle.
[0062] For the first offset angle, optionally, an intermediate first offset angle is determined based on the minimum first offset angle and the maximum first offset angle. That is to say, after the minimum angle and the maximum angle between the wiper plate and the horizontal plane are determined, the intermediate angle can be further calculated as the intermediate first offset angle, that is, the minimum angle and the maximum angle are added and the average of the sum is taken.
[0063] Furthermore, the wiping disc is controlled to perform a rotation operation according to the minimum first offset angle, the middle first offset angle and the maximum first offset angle in sequence, and the target angular velocity value corresponding to the corresponding first offset angle during stable rotation is obtained. It can be understood that after determining the minimum first offset angle, the middle first offset angle and the maximum first offset angle in the first offset angle set, the wiping disc motor is started to make the wiping disc perform a rotation operation, and when the rotation of the turntable reaches stability, the angular velocity of the wiping robot corresponding to the above three first offset angles is obtained through a sensor or a detection device.
[0064] Optionally, an intermediate second offset angle is determined based on the minimum second offset angle and the maximum second offset angle, and the wiper disk is controlled to perform a rotation operation based on the minimum second offset angle, the intermediate second offset angle and the maximum second offset angle in sequence, and the target linear speed values corresponding to each second offset angle during stable rotation are obtained.
[0065] For example, the minimum second offset angle of 10° and the maximum second offset angle of 20° corresponding to the current ground friction coefficient can be determined from the empirical table. According to the pre-set rules, the middle second offset angle of 15° can be obtained by adding and averaging the two. After determining the above three second offset angles in the second offset angle set, the trowel robot can perform trowel operations based on the above three angles respectively. According to the minimum second offset angle (i.e., adjusting the angle between the trowel plate and the horizontal plane to 10°), after the trowel robot reaches a stable straight-line running state, the final linear speed value v1 can be determined based on the detection device or sensor, and then the final linear speed values v2 and v3 can be determined under the corresponding stable running state according to the middle second offset speed of 15° and the maximum second offset speed of 20°, so as to achieve the acquisition of the target linear speed value.
[0066] S240. If each speed-related value is within the corresponding preset speed range, the calibration coefficient of the polishing robot is determined according to each first offset angle in the first offset angle set, each second offset angle in the second offset angle set, at least three speed-related values corresponding to each first offset angle, at least three speed-related values corresponding to each second offset angle, and the wiping disk rotation speed of the wiping disk, so as to control the operation of the polishing robot based on the calibration coefficient.
[0067] Exemplarily, for the first offset angle set, the minimum first offset angle of 10°, the middle first offset angle of 15° and the maximum first offset angle of 20° can be determined. Correspondingly, when the wiping plate rotates stably, the angular velocities of the finishing robot corresponding to the above three angles are 10rad / s, 20rad / s and 30rad / s respectively, and they are all within the preset speed range. Based on the above data, the calibration coefficients of the finishing robot in the three corresponding states can be determined respectively. During the execution of the task, the finishing robot can select the corresponding calibration coefficient according to the actual operating state, and then adjust its own posture information in real time through the corresponding calibration coefficient.
[0068] In actual application, there may be situations where each speed-related value is not within the corresponding preset speed range, which is explained in detail below.
[0069] Optionally, if it is detected that the target angular velocity value is not within the preset angular velocity range, the first offset angle corresponding to the target angular velocity value is determined and used as the first offset angle to be updated; based on the first offset angle to be updated and the preset superposition angle, the first offset angle to be updated in the first offset angle set is updated, and the target angular velocity value when rotating based on the updated first offset angle is determined.
[0070] Among them, when the trowel robot is running stably, if the detected target angular velocity value cannot be within the preset angular velocity range, it proves that if the first offset angle is taken as the angle between the current trowel plate and the horizontal plane, the trowel robot cannot perform the task normally, so it is necessary to determine the current first offset angle and use it as the first offset angle to be updated. It should be noted that the first offset angle to be updated can be one or more. When multiple first offset angles to be updated are updated, the trowel robot needs to perform the trowel operation for each updated first offset angle respectively until it reaches a stable operation state, thereby determining the target angular velocity value corresponding to each updated first offset angle.
[0071] At the same time, a superposition angle is preset for the finishing robot, and the first offset angle to be updated is added to the preset superposition angle to obtain an updated first offset angle. For example, the first offset angle to be updated is angle1, and the preset superposition angle is ε. After adding the two angles, the updated first offset angle angle2 can be obtained. Furthermore, according to the updated first offset angle angle2, the finishing robot can determine a new target angular velocity value, and determine again whether it is within the preset speed range. If it is within the range, the subsequent steps of this embodiment are executed. If it is still not within the preset range, the current first offset angle is used as the first offset angle to be updated, and ε is continued to be superimposed. The above steps are repeated until the target angular velocity value meets the requirements (i.e., falls within the preset angular velocity range).
[0072] Optionally, if it is detected that the target linear speed value is not within the preset linear speed range, the second offset angle corresponding to the target linear speed value is determined and used as the second offset angle to be updated; based on the second offset angle to be updated and the preset superposition angle, the second offset angle to be updated in the second offset angle set is updated, and the target linear speed value when rotating based on the updated second offset angle is determined.
[0073] Among them, for the case where the target linear velocity value is not within the preset linear velocity range, the processing method is the same as the case where the target angular velocity value is not within the preset range, and will not be repeated here.
[0074] In order to clearly introduce the technical solution of this embodiment, Figure 5 and Figure 6 The above processing is further explained.
[0075] See also Figure 5 After determining the ground friction coefficient of the current ground according to the wiper load rate, an empirical table representing the corresponding relationship between the ground friction coefficient and multiple groups of offset angles can be obtained. In the empirical table, a first offset angle set can be determined, and the minimum value therein is selected to rotate the wiper. When the trowel robot reaches a stable operating state, it is determined whether the target angular velocity value of the trowel robot is within the preset speed range. If the judgment result is yes, the middle value and the highest value in the first offset angle set are continued to be judged. If the judgment result is no, the current first offset angle is increased by the preset superposition angle size, and the empirical table corresponding to the first offset angle is obtained again. The above process is executed until the target angular velocity value corresponding to the trowel robot can be within the preset speed range. It should be noted that the middle value in the first offset angle set can be calculated based on the minimum value and the maximum value, that is, the average value of the sum of the two is taken as the middle value.
[0076] See also Figure 6After determining the ground friction coefficient of the current ground according to the wiper load rate, an empirical table representing the corresponding relationship between the ground friction coefficient and multiple groups of offset angles can be obtained. In the empirical table, a second offset angle set can be determined, and the minimum value therein can be selected to make the trowel robot move in a straight line. When the trowel robot maintains a uniform speed, it is determined whether the target linear speed value of the trowel robot is within the preset speed range. If the judgment result is yes, the middle value and the highest value in the second offset angle set are continued to be judged. If the judgment result is no, the current second offset angle is increased by the preset superposition angle size, and the empirical table corresponding to the second offset angle is obtained again. The above process is executed until the linear running speed corresponding to the trowel robot can be within the preset speed range. It should be noted that the middle values in the second offset angle set can be calculated based on the minimum value and the maximum value, that is, the average value of the sum of the two is taken as the middle value.
[0077] The technical solution of this embodiment determines the ground friction coefficient according to the wiper plate load rate, and determines the calibration coefficient of the polishing robot according to each offset angle set, at least three speed association values corresponding to each offset angle set, and the wiper plate rotation speed of the wiper plate, thereby further improving the intelligence level of the polishing robot; when each speed association value is not within the corresponding preset speed range, the offset angle can be adjusted once or multiple times based on the preset superposition angle until the speed association value meets the requirements of the work site, thereby enhancing the adaptability of the polishing robot to various working conditions.
[0078] Embodiment 3
[0079] Figure 7 A flow chart of a coefficient calibration method applied to a trowel robot provided in the third embodiment of the present invention. On the basis of the above-mentioned embodiments, the calibration coefficient of the trowel robot can be determined according to each first offset angle in the first offset angle set, each second offset angle in the second offset angle set, at least three speed-related values corresponding to each first offset angle, at least three speed-related values corresponding to each second offset angle, and the trowel rotation speed of the trowel plate, so as to control the operation of the trowel robot based on the calibration coefficient; the trowel robot periodically determines the ground friction coefficient, and can re-determine the corresponding calibration coefficient when the ground friction coefficient changes, thereby ensuring the operational reliability of the trowel robot and enhancing the adaptability of the trowel robot to complex working conditions. The specific implementation method can refer to the technical solution of this embodiment. Among them, the technical terms that are the same as or corresponding to the above-mentioned embodiments are not repeated here.
[0080] like Figure 7 As shown, the method specifically comprises the following steps:
[0081] S310. Determine a first offset angle set and a second offset angle set corresponding to the wiper according to the ground friction coefficient.
[0082] S320, controlling the wiper disc to perform a rotation operation based on the first offset angle, and obtaining at least one target angular velocity value corresponding to the first offset angle set during stable rotation, controlling the wiper disc to perform a rotation operation based on the second offset angle, and obtaining at least one target linear velocity value corresponding to the second offset angle set during stable rotation.
[0083] S330. If each speed-related value is within the corresponding preset speed range, the calibration coefficient of the finishing robot is determined according to each first offset angle in the first offset angle set, each second offset angle in the second offset angle set, at least three speed-related values corresponding to each first offset angle, at least three speed-related values corresponding to each second offset angle, and the wiping disk rotation speed of the wiping disk, so as to control the operation of the finishing robot based on the calibration coefficient.
[0084] Optionally, for each first offset angle in the first offset angle set, an angular velocity control parameter is determined according to a current first offset angle, a target angular velocity value corresponding to the current first offset angle, and a wiper rotation speed;
[0085] Here, the minimum first offset angle in the first offset angle set is taken as an example for description, and K1 represents the angular velocity control parameter corresponding to the minimum first offset angle, and its value can be determined according to the formula ω=K1*angle1*w1.
[0086] Wherein, ω represents the target angular velocity value of the trowel machine, angle1 represents the current first offset angle, that is, the angle between the trowel plate and the horizontal plane, and w1 represents the rotation speed of the trowel plate when the trowel machine is in stable operation. When the above three values are determined, the corresponding angular velocity control parameter K1 can be determined for the minimum first offset angle. Furthermore, for the intermediate first offset angle and the maximum first offset angle, the trowel robot can perform trowel operations respectively, and determine the angular velocity control parameters K2 and K3 corresponding to the intermediate first offset angle and the maximum first offset angle when the stable operation state is reached. According to the three determined angular velocity control parameters, the angular velocity values of the trowel robot in at least three stable operation states can be controlled and adjusted.
[0087] Accordingly, for each second offset angle in the second offset angle set, a linear speed control coefficient is determined according to the current second offset angle, the target linear speed value corresponding to the current second offset angle, and the wiper rotation speed;
[0088] Here, the minimum second offset angle is taken as an example for explanation, and K′1 represents the linear speed control coefficient corresponding to the minimum second offset angle, and its value can be determined according to the formula v=K′1*angle2*w1.
[0089] In the formula, v represents the target linear speed value of the trowel machine, angle2 represents the current second offset angle, that is, the angle between the trowel disc and the horizontal plane, and w1 represents the rotation speed of the trowel disc when the trowel machine is in stable operation. When the above three values are determined, the corresponding linear speed control coefficient K′1 can be determined for the minimum second offset angle. Furthermore, for the middle second offset angle and the maximum second offset angle, the trowel robot can perform trowel operations respectively, and determine the linear speed control coefficients K′2 and K′3 corresponding to the middle second offset angle and the maximum second offset angle when the stable state is reached, thereby realizing the closed-loop calibration of the linear speed of the trowel robot. According to the three determined linear speed control coefficients, the linear speed values of the trowel robot in at least three stable operating states can be controlled and adjusted.
[0090] The angle loop control coefficient is determined according to the preset angular velocity expected value and the step response function.
[0091] In this embodiment, in order to perform PID control on the finishing robot in the working state, an expected angular velocity value is pre-set for a specific first offset angle, that is, the sum of multiple operation results of the finishing robot under the current working conditions and the probability of each result; at the same time, a step response function is pre-set, and the expected angular velocity value is used as a step input to determine the corresponding angle loop control coefficient.
[0092] Optionally, the acceleration value is determined according to the ground friction coefficient and the target angular velocity value, and the angle loop control coefficient is determined according to the acceleration value, the expected angular velocity value and the step response function.
[0093] In this embodiment, the acceleration value corresponding to each first offset angle can be determined by the time it takes for the angular velocity of the trowel robot to change from zero to stable. It should be noted that the friction coefficient only affects the acceleration, and will not affect the target angular velocity value corresponding to the trowel robot after reaching a stable state.
[0094] At the same time, the expected angular velocity can be set as angular_speed, and the expected angular velocity can be used as the input of the step response function to obtain the step response time t; further, the step response time is divided into rise time and fall time. Therefore, according to the rise time t in the step response time r , based on the formula F = 1 / t r The control frequency of the angle loop can be determined.
[0095] For different models of finishing robots, a mapping table is pre-set to represent the relationship between the control frequency, acceleration, friction coefficient and angle loop PID control coefficient. When the control frequency, acceleration and friction coefficient are determined, the corresponding angle loop PID control coefficient can be obtained by looking up the table, thereby realizing the calibration of the angular velocity and angle loop PID control coefficient of the finishing robot.
[0096] S340, periodically determining the ground friction coefficient, and when a change in the ground friction coefficient is detected, repeatedly determining the first offset angle set and the second offset angle set corresponding to the wiping plate, and determining the calibration coefficient of the trowel robot.
[0097] In actual application, the working conditions on site are usually more complicated. For example, the coating conditions of materials such as concrete and cement are different at different locations on the ground, which results in different ground friction coefficients. Therefore, the trowel robot can periodically determine the ground friction coefficient at a certain time interval, so that when a change in the ground friction coefficient is detected, the relevant control coefficients of the trowel robot are recalibrated based on the current ground friction coefficient. This ensures the reliability of the trowel robot's operation and enhances its adaptability to complex working conditions.
[0098] The technical solution of this embodiment can determine the calibration coefficient of the finishing robot according to each first offset angle in the first offset angle set, each second offset angle in the second offset angle set, at least three speed-related values corresponding to each first offset angle, at least three speed-related values corresponding to each second offset angle, and the finishing rotation speed of the wiping plate, so as to control the operation of the finishing robot based on the calibration coefficient; the finishing robot can periodically determine the ground friction coefficient and redetermine the corresponding calibration coefficient when the ground friction coefficient changes, thereby ensuring the operating reliability of the finishing robot and enhancing the adaptability of the finishing robot to complex working conditions.
[0099] Embodiment 4
[0100] On the basis of the above-mentioned embodiment, the process of controlling the operation of the trowel robot based on the determined calibration coefficient is specifically described. The specific implementation method thereof can be referred to the technical solution of this embodiment. Among them, the technical terms that are the same as or corresponding to the above-mentioned embodiment are not repeated here.
[0101] S410. Determine a first offset angle set and a second offset angle set corresponding to the wiper according to the ground friction coefficient.
[0102] S420, controlling the wiper disk to perform a rotation operation based on the first offset angle, and obtaining at least one target angular velocity value corresponding to the first offset angle set during stable rotation, and controlling the wiper disk to perform a rotation operation based on the second offset angle, and obtaining at least one target linear velocity value corresponding to the second offset angle set during stable rotation.
[0103] S430. If at least one target angular velocity value is within the corresponding preset angular velocity range, and at least one target linear velocity value is within the corresponding preset linear velocity range, a calibration coefficient of the finishing robot is determined according to the first offset angle set, the second offset angle set, the at least one target angular velocity value, and the at least one target linear velocity value, so as to control the operation of the finishing robot based on the calibration coefficient.
[0104] Among them, when the trowel robot takes different first offset angles, the corresponding angular velocity control parameters and angle loop control coefficients can be determined when a stable operating state is reached; when the trowel robot takes different second offset speeds, the corresponding linear velocity control coefficients can be determined when a stable operating state is reached. Therefore, in the actual working process of the trowel robot, the position information of the trowel robot can be controlled based on the angular velocity control parameters and the angle loop control coefficients; the linear velocity information of the robot can be controlled according to the linear velocity control coefficient.
[0105] Specifically, according to the actual angular velocity value of the finishing robot, the angular velocity control parameters and the angle loop control coefficient that match the actual angular velocity value are retrieved to control the position and posture information of the finishing robot.
[0106] For example, for the first offset angle set (including the minimum first offset angle, the middle first offset angle and the maximum first offset angle), the trowel robot has determined the angular velocity control parameters K1, K2 and K3 corresponding to the three first offset angles. Based on this, when the trowel robot performs the trowel operation in the current working scene, the detection device or sensor can be used to obtain the current actual angular velocity value, and the angular velocity control parameter corresponding to the current operating state can be determined according to the actual angular velocity value, such as the angular velocity control parameter K1 corresponding to the current operating state, and the actual angular velocity value of the trowel robot can be adjusted in real time using K1.
[0107] At the same time, corresponding to the three determined angular velocity control parameters, the trowel robot also determines the angle loop PID control coefficient. In the current working scene of the trowel robot, a three-dimensional space coordinate system can be constructed, with the ground as the plane determined by the X-axis and Y-axis, and the direction perpendicular to the ground as the Z-axis direction. Based on this, when the trowel robot performs the working task and adjusts the actual angular velocity value according to the corresponding angular velocity control parameters, it can also continuously control the posture of the trowel robot according to the angle loop PID control coefficient corresponding to the current stable operating state.
[0108] Similar to the above process of controlling the position information of the trowel robot based on the calibration coefficient, for the second offset angle set, the trowel robot has determined the linear speed control parameters K′1, K′2, and K′3 corresponding to the three second offset angles. Based on this, when the trowel robot performs the trowel operation in the current working scene, the current actual operating speed can be obtained by using the detection device or sensor, and the linear speed control coefficient corresponding to the current operating state can be determined according to the actual operating speed, such as the linear speed control coefficient K′1 corresponding to the current operating state, and the actual linear speed of the trowel robot can be adjusted in real time using K′1.
[0109] According to the technical solution of this embodiment, after calibrating the control coefficients corresponding to the first offset angle set and the second offset angle set, the finishing robot can select the calibrated control coefficients under the corresponding operating state according to the actual angular velocity or linear velocity value when performing the finishing task, and can adjust its own posture information and operating speed in real time based on the control coefficients.
[0110] Embodiment 5
[0111] Figure 8 This is a structural block diagram of a coefficient calibration device applied to a trowel robot provided in the fifth embodiment of the present invention, which can execute the coefficient calibration method applied to a trowel robot provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method. Figure 8 As shown, the device specifically includes: an offset angle determination module 510, a wiper disk rotation operation control module 520 and a calibration coefficient determination module 530.
[0112] The offset angle determination module 510 is used to determine a first offset angle set and a second offset angle set corresponding to the wiper according to the ground friction coefficient, wherein the first offset angle set includes at least one first offset angle, and the second offset angle set includes at least one second offset angle, and the first offset angle and the second offset angle are the angles between the wiper and the horizontal plane.
[0113] The wiper disk rotation operation control module 520 is used to control the wiper disk to perform a rotation operation based on the first offset angle, and obtain at least one target angular velocity value corresponding to the first offset angle set during stable rotation, and to control the wiper disk to perform a rotation operation based on the second offset angle, and obtain at least one target linear velocity value corresponding to the second offset angle set during stable rotation.
[0114] The calibration coefficient determination module 530 is used to determine the calibration coefficient of the finishing robot according to the first offset angle set, the second offset angle set, the at least one target angular velocity value and the at least one target linear velocity value if the at least one target angular velocity value is within the corresponding preset angular velocity range and the at least one target linear velocity value is within the corresponding preset linear velocity range, so as to control the operation of the finishing robot based on the calibration coefficient; wherein the calibration coefficient includes an angular velocity control parameter, an angle loop control coefficient and a linear velocity control coefficient.
[0115] On the basis of the above-mentioned technical solutions, the coefficient calibration device applied to the trowel robot also includes a ground friction coefficient determination module.
[0116] The ground friction coefficient determination module is used to adjust the angle between the wiper plate and the horizontal plane to a preset angle, and then rotate the wiper plate; obtain the load rate of the wiper plate, and determine the ground friction coefficient of the ground according to the load rate.
[0117] Based on the above technical solutions, the first offset angle set includes at least two first offset angles, the second offset angle set includes at least two second offset angles, the at least one target angular velocity value includes a value corresponding to each first offset angle, and the at least one target linear velocity value corresponds to each second offset angle.
[0118] Based on the above technical solutions, the first offset angle set includes a minimum first offset angle and a maximum first offset angle, the second offset angle set includes a minimum second offset angle and a maximum second offset angle, and the wiper rotation operation control module 520 includes a target angular velocity value determination unit and a target linear velocity value determination unit.
[0119] A target angular velocity value determination unit is used to determine an intermediate first offset angle according to the minimum first offset angle and the maximum first offset angle, control the wiper to perform a rotation operation according to the minimum first offset angle, the intermediate first offset angle and the maximum first offset angle in sequence, and obtain the target angular velocity value corresponding to each first offset angle during stable rotation.
[0120] A target linear speed value determination unit is used to determine an intermediate second offset angle according to the minimum second offset angle and the maximum second offset angle, control the wiper disc to perform a rotation operation according to the minimum second offset angle, the intermediate second offset angle and the maximum second offset angle in sequence, and obtain the target linear speed value corresponding to each second offset angle during stable rotation.
[0121] Optionally, the target angular velocity value determination unit is also used to determine the first offset angle corresponding to the target angular velocity value and use it as the first offset angle to be updated if it is detected that the target angular velocity value is not within a preset angular velocity range; based on the first offset angle to be updated and a preset superposition angle, update the first offset angle to be updated in the first offset angle set, and determine the target angular velocity value when rotating based on the updated first offset angle.
[0122] Optionally, the target linear speed value determination unit is also used to determine the second offset angle corresponding to the target linear speed value and use it as the second offset angle to be updated if it is detected that the target linear speed value is not within the preset linear speed range; based on the second offset angle to be updated and the preset superposition angle, update the second offset angle to be updated in the second offset angle set, and determine the target linear speed value when rotating based on the updated second offset angle.
[0123] Optionally, the calibration coefficient determination module 530 is also used to determine the calibration coefficient of the polishing robot based on each first offset angle in the first offset angle set, each second offset angle in the second offset angle set, at least three target angular velocity values corresponding to each first offset angle, at least three target linear velocity values corresponding to each second offset angle, and the wiping disk rotation speed of the wiping disk.
[0124] Optionally, the calibration coefficient determination module 530 is also used to determine the angular velocity control parameter for each first offset angle in the first offset angle set according to the current first offset angle, the target angular velocity value corresponding to the current first offset angle, and the wiper rotation speed; determine the linear velocity control coefficient for each second offset angle in the second offset angle set according to the current second offset angle, the target linear velocity value corresponding to the current second offset angle, and the wiper rotation speed; and determine the angle loop control coefficient according to a pre-set angular velocity expected value and a step response function.
[0125] Optionally, the calibration coefficient determination module 530 is further used to determine the acceleration value according to the ground friction coefficient and the target angular velocity value; and to determine the angle loop control coefficient according to the acceleration value, the expected angular velocity value and the step response function.
[0126] Optionally, the calibration coefficient determination module 530 is also used to take the expected angular velocity value as the input of the step response function to obtain the step response duration; determine the control frequency of the angle loop according to the step response duration; and determine the angle loop control coefficient according to the control frequency, the acceleration value and the ground friction coefficient.
[0127] Optionally, controlling the operation of the trowel robot based on the calibration coefficient includes:
[0128] Based on the angular velocity control parameter and the angle loop control coefficient, the position information of the trowel robot is controlled; and according to the linear velocity control coefficient, the linear velocity information of the trowel robot is controlled.
[0129] Optionally, controlling the posture information of the trowel robot based on the angular velocity control parameter and the angle loop control coefficient includes:
[0130] According to the actual angular velocity value of the trowel robot, the angular velocity control parameters and the angle loop control coefficient matching the actual angular velocity value are retrieved to control the position and posture information of the trowel robot.
[0131] On the basis of the above-mentioned technical solutions, the coefficient calibration device applied to the trowel robot also includes a floor friction coefficient periodic detection module.
[0132] The floor friction coefficient periodic detection module is used to periodically determine the floor friction coefficient. When a change in the floor friction coefficient is detected, the first offset angle set and the second offset angle set corresponding to the wiping plate are repeatedly determined, and the calibration coefficient of the trowel robot is determined.
[0133] The technical solution provided in this embodiment can determine a first offset angle set and a second offset angle set relative to the trowel plate according to the ground friction coefficient, and then control the trowel plate to perform a rotation operation based on each offset angle in the set. When the trowel plate rotates stably, at least one target angular velocity value corresponding to the first offset angle set and at least one target linear velocity value corresponding to the second offset angle set are obtained. When the obtained target angular velocity value and target linear velocity value are within a preset speed range, the calibration coefficient of the trowel robot can be automatically determined, and there is no need for manual on-site calibration. This realizes the technical effect of automatically and dynamically adjusting the control coefficient in the trowel robot and improving the operation quality of the trowel robot.
[0134] The coefficient calibration device for a trowel robot provided in an embodiment of the present invention can execute the coefficient calibration method for a trowel robot provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.
[0135] It is worth noting that the various units and modules included in the above-mentioned device are only divided according to functional logic, but are not limited to the above-mentioned division, as long as the corresponding functions can be achieved; in addition, the specific names of the functional units are only for the convenience of distinguishing each other, and are not used to limit the protection scope of the embodiments of the present invention.
[0136] Embodiment 6
[0137] Fig. 9 This is a structural schematic diagram of an electronic device provided in Embodiment 6 of the present invention. Fig. 9 A block diagram of an exemplary electronic device 60 suitable for implementing exemplary embodiments of the present invention is shown. Fig. 9 The electronic device 60 shown is only an example and should not bring any limitation to the functions and scope of use of the embodiments of the present invention.
[0138] like Fig. 9 As shown, the electronic device 60 is in the form of a general computing device. The components of the electronic device 60 may include but are not limited to: one or more processors or processing units 601, a system memory 602, and a bus 603 connecting different system components (including the system memory 602 and the processing unit 601).
[0139] Bus 603 represents one or more of several types of bus structures, including a memory bus or memory controller, a peripheral bus, an accelerated graphics port, a processor or a local bus using any of a variety of bus structures. For example, these architectures include but are not limited to Industry Standard Architecture (ISA) bus, Micro Channel Architecture (MAC) bus, Enhanced ISA bus, Video Electronics Standards Association (VESA) local bus and Peripheral Component Interconnect (PCI) bus.
[0140] The electronic device 60 typically includes a variety of computer system readable media. These media can be any available media that can be accessed by the electronic device 60, including volatile and non-volatile media, removable and non-removable media.
[0141] The system memory 602 may include computer system readable media in the form of volatile memory, such as random access memory (RAM) 604 and / or cache memory 605. The electronic device 60 may further include other removable / non-removable, volatile / non-volatile computer system storage media. By way of example only, the storage system 606 may be used to read and write non-removable, non-volatile magnetic media ( Fig. 9 not shown, usually called a "hard drive"). Although Fig. 9 Not shown in the figure, a disk drive for reading and writing to a removable non-volatile disk (e.g., a "floppy disk"), and an optical disk drive for reading and writing to a removable non-volatile optical disk (e.g., a CD-ROM, a DVD-ROM, or other optical media) may be provided. In these cases, each drive may be connected to bus 603 via one or more data medium interfaces. Memory 602 may include at least one program product having a set (e.g., at least one) of program modules that are configured to perform the functions of various embodiments of the present invention.
[0142] A program / utility 608 having a set (at least one) of program modules 607 may be stored, for example, in the memory 602, such program modules 607 including but not limited to an operating system, one or more application programs, other program modules, and program data, each of which or some combination may include an implementation of a network environment. The program modules 607 generally perform the functions and / or methods of the embodiments described herein.
[0143] The electronic device 60 may also communicate with one or more external devices 609 (e.g., keyboards, pointing devices, displays 610, etc.), may communicate with one or more devices that enable a user to interact with the electronic device 60, and / or may communicate with any device that enables the electronic device 60 to communicate with one or more other computing devices (e.g., a network card, a modem, etc.). Such communication may be performed via an input / output (I / O) interface 611. Furthermore, the electronic device 60 may also communicate with one or more networks (e.g., a local area network (LAN), a wide area network (WAN), and / or a public network, such as the Internet) via a network adapter 612. As shown, the network adapter 612 communicates with other modules of the electronic device 60 via a bus 603. It should be understood that although Fig. 9 Not shown, other hardware and / or software modules may be used in conjunction with the electronic device 60, including but not limited to microcode, device drivers, redundant processing units, external disk drive arrays, RAID systems, tape drives, and data backup storage systems.
[0144] The processing unit 601 executes various functional applications and data processing by running the programs stored in the system memory 602, such as implementing the coefficient calibration method for the trowel robot provided in the embodiment of the present invention.
[0145] Embodiment 7
[0146] Embodiment 7 of the present invention further provides a storage medium comprising computer executable instructions, which, when executed by a computer processor, are used to execute a coefficient calibration method applied to a finishing robot.
[0147] The method includes:
[0148] Determine a first offset angle set and a second offset angle set corresponding to the wiper according to the ground friction coefficient, wherein the first offset angle set includes at least one first offset angle, and the second offset angle set includes at least one second offset angle, and the first offset angle and the second offset angle are angles between the wiper and a horizontal plane;
[0149] Controlling the wiper disk to perform a rotation operation based on the first offset angle, and obtaining at least one target angular velocity value corresponding to the first offset angle set during stable rotation; controlling the wiper disk to perform a rotation operation based on the second offset angle, and obtaining at least one target linear velocity value corresponding to the second offset angle set during stable rotation;
[0150] If the at least one target angular velocity value is within the corresponding preset angular velocity range, and the at least one target linear velocity value is within the corresponding preset linear velocity range, then the calibration coefficient of the finishing robot is determined according to the first offset angle set, the second offset angle set, the at least one target angular velocity value and the at least one target linear velocity value, so as to control the operation of the finishing robot based on the calibration coefficient; wherein the calibration coefficient includes an angular velocity control parameter, an angle loop control coefficient and a linear velocity control coefficient.
[0151] The computer storage medium of the embodiment of the present invention can adopt any combination of one or more computer-readable media. The computer-readable medium can be a computer-readable signal medium or a computer-readable storage medium. The computer-readable storage medium can be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples (non-exhaustive list) of computer-readable storage media include: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In this document, a computer-readable storage medium can be any tangible medium containing or storing a program, which can be used by an instruction execution system, device or device or used in combination with it.
[0152] Computer-readable signal media may include a data signal propagated in baseband or as part of a carrier wave, in which computer-readable project code is carried. Such propagated data signals may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. Computer-readable signal media may also be any computer-readable medium other than a computer-readable storage medium, which may send, propagate, or transmit a program for use by or in conjunction with an instruction execution system, apparatus, or device.
[0153] Project code embodied on a computer-readable medium may be transmitted using any appropriate medium, including but not limited to wireless, wireline, optical fiber cable, RF, etc., or any suitable combination of the foregoing.
[0154] Computer project code for performing the operation of embodiments of the present invention may be written in one or more programming languages or a combination thereof, including object-oriented programming languages, such as Java, Smalltalk, C++, and conventional procedural programming languages, such as "C" or similar programming languages. The project code may be executed entirely on the user's computer, partially on the user's computer, as a separate software package, partially on the user's computer and partially on a remote computer, or entirely on a remote computer or server. In the case of a remote computer, the remote computer may be connected to the user's computer via any type of network, including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computer (e.g., via the Internet using an Internet service provider).
[0155] Note that the above are only preferred embodiments of the present invention and the technical principles used. Those skilled in the art will understand that the present invention is not limited to the specific embodiments described herein, and that various obvious changes, readjustments and substitutions can be made by those skilled in the art without departing from the scope of protection of the present invention. Therefore, although the present invention has been described in more detail through the above embodiments, the present invention is not limited to the above embodiments, and may include more other equivalent embodiments without departing from the concept of the present invention, and the scope of the present invention is determined by the scope of the appended claims.
Claims
1. A coefficient calibration method applied to a trowel robot, characterized in that: include: Determine a first offset angle set and a second offset angle set corresponding to the wiper according to the ground friction coefficient, wherein the first offset angle set includes at least one first offset angle, and the second offset angle set includes at least one second offset angle, and the first offset angle and the second offset angle are angles between the wiper and a horizontal plane; Controlling the wiper disk to perform a rotation operation based on the first offset angle, and obtaining at least one target angular velocity value corresponding to the first offset angle set during stable rotation; controlling the wiper disk to perform a rotation operation based on the second offset angle, and obtaining at least one target linear velocity value corresponding to the second offset angle set during stable rotation; If the at least one target angular velocity value is within the corresponding preset angular velocity range, and the at least one target linear velocity value is within the corresponding preset linear velocity range, then according to the first offset angle set, the second offset angle set, the at least one target angular velocity value and the at least one target linear velocity value, a calibration coefficient of the trowel robot is determined to control the operation of the trowel robot based on the calibration coefficient; wherein the calibration coefficient includes an angular velocity control parameter, an angle loop control coefficient and a linear velocity control coefficient; for each first offset angle in the first offset angle set, according to the current first offset angle, the target angular velocity value corresponding to the current first offset angle and the trowel rotation speed, an angular velocity control parameter is determined; for each second offset angle in the second offset angle set, according to the current second offset angle, the target linear velocity value corresponding to the current second offset angle and the trowel rotation speed, a linear velocity control coefficient is determined; the angle loop control coefficient is determined according to a preset angular velocity expected value and a step response function; Among them, the angular velocity control parameter is calculated based on the following formula: ω=K1*angle1*w1; Wherein, ω represents the target angular velocity value of the trowel machine, angle1 represents the current first offset angle, w1 represents the rotation speed of the trowel disc when the trowel machine is running stably, and K1 represents the angular velocity control parameter; The line speed control coefficient is calculated based on the following formula: v = K′1*angle2*w1; Wherein, v represents the target linear speed value of the trowel machine, angle2 represents the current second offset angle, w1 represents the rotation speed of the trowel disc when the trowel machine is running stably, and K′1 represents the linear speed control coefficient; The angle loop control coefficient is calculated based on the following formula: F=1 / t r ; Where F represents the control frequency of the angle loop, t r Indicates the rise time in the step response duration; a mapping table representing the relationship between the control frequency, acceleration, friction coefficient and angle loop control coefficient is pre-set, and the corresponding angle loop control coefficient is determined according to the mapping table.
2. The method according to claim 1, characterized in that Before determining the first offset angle set and the second offset angle set corresponding to the wiper according to the ground friction coefficient, the method further includes: After adjusting the angle between the wiper plate and the horizontal plane to a preset angle, the wiper plate is rotated; The load rate of the wiper plate is obtained, and the ground friction coefficient of the ground is determined according to the load rate.
3. The method according to claim 1, characterized in that: The first offset angle set includes at least two first offset angles, the second offset angle set includes at least two second offset angles, the at least one target angular velocity value corresponds to each first offset angle, and the at least one target linear velocity value corresponds to each second offset angle.
4. The method according to claim 1, characterized in that The first offset angle set includes a minimum first offset angle and a maximum first offset angle, the second offset angle set includes a minimum second offset angle and a maximum second offset angle, the controlling the wiper disk to perform a rotation operation based on the first offset angle and obtaining at least one target angular velocity value corresponding to the first offset angle set during stable rotation, and the controlling the wiper disk to perform a rotation operation based on the second offset angle and obtaining at least one target linear velocity value corresponding to the second offset angle set during stable rotation include: Determine an intermediate first offset angle according to the minimum first offset angle and the maximum first offset angle, control the wiper to perform a rotation operation according to the minimum first offset angle, the intermediate first offset angle, and the maximum first offset angle in sequence, and obtain a target angular velocity value corresponding to each first offset angle during stable rotation; According to the minimum second offset angle and the maximum second offset angle, an intermediate second offset angle is determined, and the wiper disc is controlled to perform a rotation operation according to the minimum second offset angle, the intermediate second offset angle and the maximum second offset angle in sequence, and the target linear velocity value corresponding to each second offset angle during stable rotation is obtained.
5. The method according to claim 4, characterized in that Also includes: If it is detected that the target angular velocity value is not within the preset angular velocity range, determining a first offset angle corresponding to the target angular velocity value and using it as the first offset angle to be updated; Based on the first offset angle to be updated and the preset superposition angle, updating the first offset angle to be updated in the first offset angle set, and determining a target angular velocity value when rotating based on the updated first offset angle; and / or, If it is detected that the target linear velocity value is not within the preset linear velocity range, a second offset angle corresponding to the target linear velocity value is determined and used as the second offset angle to be updated; Based on the second offset angle to be updated and the preset superposition angle, the second offset angle to be updated in the second offset angle set is updated, and a target linear velocity value when rotating based on the updated second offset angle is determined.
6. The method according to claim 1, characterized in that The step of determining a calibration coefficient of the trowel robot according to the first offset angle set, the second offset angle set, the at least one target angular velocity value, and the at least one target linear velocity value comprises: The calibration coefficient of the finishing robot is determined based on each first offset angle in the first offset angle set, each second offset angle in the second offset angle set, at least three target angular velocity values corresponding to each first offset angle, at least three target linear velocity values corresponding to each second offset angle, and the wiping plate rotation speed of the wiping plate.
7. The method according to claim 1, characterized in that Also includes: Determining an acceleration value according to the ground friction coefficient and the target angular velocity value; Determining the angle loop control coefficient according to the preset angular velocity expected value and the step response function includes: The angle loop control coefficient is determined according to the acceleration value, the expected angular velocity value and the step response function.
8. The method according to claim 7, characterized in that Determining the angle loop control coefficient according to the acceleration value, the expected angular velocity value and the step response function includes: Taking the expected value of angular velocity as the input of the step response function to obtain the step response duration; Determining the control frequency of the angle loop according to the step response duration; The angle loop control coefficient is determined according to the control frequency, the acceleration value and the ground friction coefficient.
9. The method according to claim 1, characterized in that: The step of controlling the operation of the trowel robot based on the calibration coefficient comprises: Based on the angular velocity control parameter and the angle loop control coefficient, controlling the position and posture information of the trowel robot; The linear speed information of the finishing robot is controlled according to the linear speed control coefficient.
10. The method according to claim 9, characterized in that The controlling the posture information of the trowel robot based on the angular velocity control parameter and the angle loop control coefficient includes: According to the actual angular velocity value of the trowel robot, the angular velocity control parameters and the angle loop control coefficient matching the actual angular velocity value are retrieved to control the position and posture information of the trowel robot.
11. The method according to claim 1, characterized in that: Also includes: The ground friction coefficient is periodically determined, and when a change in the ground friction coefficient is detected, the first offset angle set and the second offset angle set corresponding to the wiping plate are repeatedly determined, and the calibration coefficient of the trowel robot is determined.
12. A coefficient calibration device applied to a trowel robot, characterized in that: include: an offset angle determination module, for determining a first offset angle set and a second offset angle set corresponding to the wiper according to a ground friction coefficient, wherein the first offset angle set includes at least one first offset angle, the second offset angle set includes at least one second offset angle, and the first offset angle and the second offset angle are angles between the wiper and a horizontal plane; a wiper disk rotation operation control module, configured to control the wiper disk to perform a rotation operation based on the first offset angle, and obtain at least one target angular velocity value corresponding to the first offset angle set during stable rotation, and to control the wiper disk to perform a rotation operation based on the second offset angle, and obtain at least one target linear velocity value corresponding to the second offset angle set during stable rotation; A calibration coefficient determination module, for determining the calibration coefficient of the trowel robot according to the first offset angle set, the second offset angle set, the at least one target angular velocity value and the at least one target linear velocity value if the at least one target angular velocity value is within the corresponding preset angular velocity range and the at least one target linear velocity value is within the corresponding preset linear velocity range, so as to control the operation of the trowel robot based on the calibration coefficient; wherein the calibration coefficient includes an angular velocity control parameter, an angle loop control coefficient and a linear velocity control coefficient; for each first offset angle in the first offset angle set, the angular velocity control parameter is determined according to the current first offset angle, the target angular velocity value corresponding to the current first offset angle and the rotation speed of the trowel; for each second offset angle in the second offset angle set, the linear velocity control coefficient is determined according to the current second offset angle, the target linear velocity value corresponding to the current second offset angle and the rotation speed of the trowel; the angle loop control coefficient is determined according to a preset angular velocity expected value and a step response function; The calibration coefficient determination module is also used for: The angular velocity control parameters are calculated based on the following formula: ω=K1*angle1*w1; Wherein, ω represents the target angular velocity value of the trowel machine, agnle1 represents the current first offset angle, w1 represents the rotation speed of the trowel disc when the trowel machine is running stably, and K1 represents the angular velocity control parameter; The line speed control coefficient is calculated based on the following formula: v = K′1*agnle2*w1; Wherein, v represents the target linear speed value of the trowel machine, angle2 represents the current second offset angle, w1 represents the rotation speed of the trowel disc when the trowel machine is running stably, and K′1 represents the linear speed control coefficient; The angle loop control coefficient is calculated based on the following formula: F=1 / t r ; Where F represents the control frequency of the angle loop, t r Indicates the rise time in the step response duration; a mapping table representing the relationship between the control frequency, acceleration, friction coefficient and angle loop control coefficient is pre-set, and the corresponding angle loop control coefficient is determined according to the mapping table.
13. An electronic device, characterized in that: The electronic device comprises: one or more processors; a storage device for storing one or more programs, When the one or more programs are executed by the one or more processors, the one or more processors implement the coefficient calibration method applied to a finishing robot as described in any one of claims 1-11.
14. A storage medium comprising computer executable instructions, wherein the computer executable instructions are used to execute the coefficient calibration method for a trowel robot as claimed in any one of claims 1 to 11 when executed by a computer processor.
