A control method, device and storage medium for simulating human foot pedaling

By obtaining the worker's musical stomping data, establishing a motion model and driving the mechanical foot, the problem of inability to simulate manual musical stomping in mechanized musical stomping is solved, the accuracy of musical stomping is improved, and the aging and difficulty in recruiting wine brewing enterprises are solved.

CN115741693BActive Publication Date: 2024-12-03SHENZHEN NONGBO INNOVATION TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202211453065.2
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-11-18
Publication Date
2024-12-03
Estimated Expiration
2042-11-18

AI Technical Summary

Technical Problem

The existing mechanized music making technology cannot effectively simulate the strength and movements of real female workers on the music, resulting in low accuracy of mechanical simulation of manual music, which leads to the problems of aging and difficulty in recruiting workers.

Method used

By obtaining foot position data, motion inertia data and surface pressure values ​​during the worker's beating process, establishing a motion model, determining simulated motion parameters, and generating control instructions based on these parameters to drive the mechanical foot, simulating the beating movement of the real worker.

Benefits of technology

The accuracy of mechanical foot simulating artificial stomping is improved, so that it can reach a designated position at a certain moment, simulate the strength and movement of real workers in bending, thus solving the accuracy problem of mechanized stomping.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115741693B_ABST
    Figure CN115741693B_ABST
Patent Text Reader

Abstract

The present invention discloses a control method, a device and a storage medium for simulating human foot pedaling, wherein the control method for simulating human foot pedaling comprises the following steps: obtaining position data and motion inertia data of the feet of a real pedaler at different times during the pedaling process of the worker; obtaining surface pressure values ​​of different areas of the pedal block at different times during the pedaling process of the worker; forming a motion model using the surface pressure values, position data and motion inertia data, and determining simulation motion parameters according to the motion model; comparing the simulation motion parameters with parameter thresholds of a real mechanical foot, and generating a final motion trajectory of a target point according to the comparison result; generating a control instruction according to the final simulation motion trajectory to drive the real mechanical foot; the technical solution of the present invention realizes the function of generating a function that enables the mechanical foot to reach a specified position at a certain moment after collecting motion data, thereby simulating the pedaling strength and action of a real worker.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of wine production, and in particular to a control method, a device and a storage medium for simulating human foot tapping. Background Art

[0002] The production process of koji blocks is generally completed by female workers, but due to the high temperature and humidity in the koji-making environment and the high intensity of the work of stepping on the koji, wine-brewing companies generally have problems of aging and difficulty in recruiting workers. With the development of data and technology, major wine companies have begun to try mechanized koji making, but most of the mechanization uses hydraulic cylinders combined with contoured molds, which have a single action and cannot simulate the strength and actions of real female workers stepping on the koji, resulting in low accuracy of real mechanical feet in simulating manual koji stepping operations. Summary of the invention

[0003] The main purpose of the present invention is to provide a control method for simulating human foot pedaling, aiming to solve the technical problem that the prior art cannot simulate artificial pedaling.

[0004] To achieve the above object, the control method for simulating human foot pedaling provided by the present invention comprises the following steps:

[0005] Obtain the position data and motion inertia data of the actual foot of the worker at different times during the process of stepping on the curve;

[0006] Obtain the surface pressure values ​​of the curved block in different areas at different times when the worker is stepping on the curved block;

[0007] Using surface pressure values, position data, and motion inertia data to form a motion model, and determining simulation motion parameters based on the motion model;

[0008] Comparing the simulated motion parameters with the parameter thresholds of the real mechanical foot, and generating a final motion trajectory of the target point according to the comparison result;

[0009] Generate control instructions based on the final simulated motion trajectory to drive the real robotic foot.

[0010] Preferably, the step of forming a motion model using surface pressure values, position data, and motion inertia data, and determining simulation motion parameters according to the motion model, further includes the following steps:

[0011] According to the position data, motion inertia data and the surface pressure value of the worker during the bending process, respectively establish the original function relationship group of the position data, the motion inertia data, the surface pressure value and time, and use the original function relationship group to form an initial motion model, and determine the original simulation motion parameters according to the original motion model;

[0012] Using a correction mechanical foot that is restored one-to-one with the foot of a real person who steps on the curve, the position data and posture data of the correction mechanical foot at different times during the correction process are obtained; and the surface pressure values ​​of different areas of the curve block at different times during the correction process are obtained;

[0013] According to the position data, motion inertia data and the surface pressure value in the correction process, respectively establishing a correction function relationship group of the position data, the motion inertia data, the surface pressure value and time;

[0014] The mechanical foot is driven and corrected by the original simulation motion parameters, the correction function relationship group is compared with the original function relationship group, and the final simulation motion parameters are formed according to the comparison result.

[0015] Preferably, the step of comparing the simulated motion parameters with the parameter thresholds of the real mechanical foot and generating the final motion trajectory of the target point according to the comparison result comprises the following steps:

[0016] The simulated motion parameters include simulated rotation angle, simulated angular velocity and simulated acceleration;

[0017] Comparing the simulated rotation angle with the rotation angle threshold of each leg bone of the real mechanical foot;

[0018] comparing the simulated angular velocity with the angular velocity thresholds of each leg bone of the real mechanical foot;

[0019] Comparing the simulated acceleration with the acceleration thresholds of each leg bone of the real mechanical foot;

[0020] When any one of the simulated rotation angle, simulated angular velocity, and simulated acceleration is greater than the corresponding parameter threshold, the simulated motion trajectory is adjusted so that the simulated motion parameters of each arm in the foot model matched therewith are all less than the corresponding parameter threshold;

[0021] When the simulated rotation angle, simulated angular velocity, and simulated acceleration are all less than the corresponding parameter thresholds, the simulated motion trajectory is taken as the final motion trajectory.

[0022] Preferably, the step of driving and correcting the mechanical foot by using the original simulation motion parameters, comparing the correction function relationship group with the original function relationship group, and forming the final simulation motion parameters according to the comparison result, further includes the following steps:

[0023] If the error between the correction function relationship group and the original function relationship group is less than the preset error, the original simulation motion parameters are taken as the final simulation motion parameters;

[0024] If the comparison error between the correction function relationship group and the original function relationship group is greater than the preset error, the original simulation motion parameters are adjusted to form adjusted simulation motion parameters, and the adjusted simulation motion parameters are used to drive the correction mechanical foot until the comparison error between the adjusted correction function relationship group and the original function relationship group is less than the preset error, and the adjusted simulation motion parameters are taken as the final simulation motion parameters.

[0025] Preferably, the step of obtaining the position data and motion inertia data of the feet of the actual worker at different times during the bending process comprises the following steps:

[0026] The position data includes the spatial motion trajectory of the foot of the real person who steps on the curve, and the motion inertia data includes the acceleration and angular velocity of the foot of the real person who steps on the curve at different times.

[0027] Preferably, the position data includes the spatial motion trajectory of the foot of the real person who steps on the curve, and the motion inertia data includes the acceleration and angular velocity of the foot of the real person who steps on the curve at different times, including the following steps:

[0028] The inertial measurement unit and the position sensor are attached to the target point of the foot of the real person who is bending the bends. The acceleration, angular velocity and spatial motion trajectory of the foot of the real person who is bending the bends at different times during the worker's bending process are collected using the inertial measurement unit and the position sensor to form a data set of acceleration and angular velocity and a spatial motion trajectory, and the rotation angle that changes with time is determined based on the spatial motion trajectory.

[0029] Preferably, the step of obtaining the surface pressure values ​​of different areas of the block at different times comprises the following steps:

[0030] The surface of the curved block is divided into several regions, and the surface pressure values ​​of different regions at different times are obtained.

[0031] In addition, to achieve the above-mentioned purpose, the present invention also provides a control device for simulating human foot pedaling, the control device for simulating human foot pedaling comprising:

[0032] The data acquisition module is used to obtain the position data and motion inertia data of the feet of the actual person stepping on the bend at different times during the worker stepping on the bend; and is used to obtain the surface pressure values ​​of the bend block in different areas at different times during the worker stepping on the bend;

[0033] A simulation motion parameter module is used to establish a motion model using surface pressure values, position data, and motion inertia data, and to determine simulation motion parameters based on the motion model;

[0034] A simulation trajectory generation module, used for comparing the simulation motion parameters with the parameter thresholds of the real mechanical foot, and generating a final motion trajectory of the target point according to the comparison result;

[0035] The driving module is used to generate control instructions according to the final simulated motion trajectory to drive the real mechanical foot.

[0036] Preferably, the data acquisition module includes an inertial measurement unit, a position sensor and a pressure sensor; the inertial measurement unit is used to obtain the angular velocity and acceleration of the foot of the real person stepping on the curve; the position sensor is used to obtain the spatial motion trajectory of the foot of the real person stepping on the curve; and the pressure sensor is used to obtain the surface pressure value of the curve.

[0037] In addition, to achieve the above-mentioned purpose, the present invention also proposes a computer-readable storage medium, on which a computer program is stored. When the computer program is executed by a processor, the steps of the control method for simulating human foot pedaling as described above are implemented.

[0038] The technical solution of the present invention obtains the position data and motion inertia data of the feet of a real person stepping on the bend at different times during the worker's stepping on the bend, and obtains the surface pressure values ​​of different areas of the bend block at different times during the worker's stepping on the bend; then uses the surface pressure values, position data, and motion inertia data to form a motion model, and determines the simulation motion parameters according to the motion model; compares the simulation motion parameters with the parameter thresholds of the real mechanical foot, and generates the final motion trajectory of the target point according to the comparison result, and finally generates a control instruction to drive the real mechanical foot according to the final simulation motion trajectory. This series of steps solves the technical problem that artificial stepping on the bend cannot be simulated in the prior art, and realizes the function of generating a mechanical foot to reach a specified position at a certain moment after collecting motion data, thereby simulating the stepping strength and movements of the real worker, thereby greatly increasing the accuracy of the real mechanical foot in simulating artificial stepping on the bend. BRIEF DESCRIPTION OF THE DRAWINGS

[0039] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on the structures shown in these drawings without paying creative work.

[0040] Figure 1 The present invention is a flow chart of an embodiment of a control method for simulating human foot pedaling.

[0041] Figure 2 for Figure 1 Schematic diagram of the process of step S300.

[0042] Figure 3 for Figure 2 Schematic diagram of the process of step S34.

[0043] Figure 4 for Figure 1 Schematic diagram of the process of step S400.

[0044] Figure 5 for Figure 1 Schematic diagram of the process of step S100.

[0045] Figure 6 for Figure 1 Schematic diagram of the process of step S11 in FIG.

[0046] Figure 7 for Figure 1 Schematic diagram of the process of step S200.

[0047] Figure 8 It is a schematic diagram of the structural framework of an embodiment of a control device for simulating human foot pedaling according to the present invention.

[0048] The realization of the purpose, functional features and advantages of the present invention will be further explained in conjunction with embodiments and with reference to the accompanying drawings. DETAILED DESCRIPTION

[0049] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0050] It should be noted that if the embodiments of the present invention involve directional indications (such as up, down, left, right, front, back, etc.), the directional indications are only used to explain the relative position relationship, movement status, etc. between the components in a certain specific posture. If the specific posture changes, the directional indication will also change accordingly.

[0051] In addition, if there are descriptions involving "first", "second", etc. in the embodiments of the present invention, the descriptions of "first", "second", etc. are only used for descriptive purposes and cannot be understood as indicating or implying their relative importance or implicitly indicating the number of technical features indicated. Therefore, the features limited to "first" and "second" may explicitly or implicitly include at least one of the features. In addition, if "and / or" or "and / or" appears in the full text, its meaning includes three parallel solutions. Taking "A and / or B" as an example, it includes solution A, solution B, or solutions that satisfy both A and B. In addition, the technical solutions between the various embodiments can be combined with each other, but it must be based on the ability of ordinary technicians in this field to implement. When the combination of technical solutions is contradictory or cannot be implemented, it should be deemed that such combination of technical solutions does not exist and is not within the scope of protection required by the present invention.

[0052] The invention provides a control method for simulating human foot pedaling.

[0053] Reference Figures 1 to 7 In one embodiment of the present invention, in order to achieve the above-mentioned purpose, the control method for simulating human foot pedaling proposed by the present invention comprises the following steps:

[0054] S100: obtaining position data and motion inertia data of the feet of the actual worker at different times during the worker's stepping process;

[0055] S200: obtaining surface pressure values ​​of different areas of the curved block at different times during the process of workers stepping on the curved block;

[0056] S300: forming a motion model using surface pressure values, position data, and motion inertia data, and determining simulation motion parameters according to the motion model;

[0057] S400: comparing the simulated motion parameters with the parameter thresholds of the real mechanical foot, and generating a final motion trajectory of the target point according to the comparison result;

[0058] S500: Generate control instructions according to the final simulated motion trajectory to drive the real mechanical foot.

[0059] The technical solution of the present invention obtains the position data and motion inertia data of the feet of a real person stepping on the bend at different times during the worker's stepping on the bend, and obtains the surface pressure values ​​of different areas of the bend block at different times during the worker's stepping on the bend; then uses the surface pressure values, position data, and motion inertia data to form a motion model, and determines the simulation motion parameters according to the motion model; compares the simulation motion parameters with the parameter thresholds of the real mechanical foot, and generates the final motion trajectory of the target point according to the comparison result, and finally generates a control instruction to drive the real mechanical foot according to the final simulation motion trajectory. This series of steps solves the technical problem that artificial stepping on the bend cannot be simulated in the prior art, and realizes the function of generating a mechanical foot to reach a specified position at a certain moment after collecting motion data, thereby simulating the stepping strength and movements of the real worker, thereby greatly increasing the accuracy of the real mechanical foot in simulating artificial stepping on the bend.

[0060] Specifically, the surface pressure value is used to determine the magnitude and direction of the force applied by the real mechanical foot to the surface of the curved block, and the motion parameters of the mechanical foot are obtained by reverse calculation based on the required force; the position data is used to form a motion trajectory, and the motion parameters of the mechanical foot are obtained by reverse calculation based on the motion trajectory; the motion inertia data includes angular velocity and acceleration, and similarly, the motion parameters of the mechanical foot are obtained by reverse calculation based on the angular velocity and acceleration.

[0061] Preferably, the step S300 of forming a motion model using surface pressure values, position data, and motion inertia data, and determining simulation motion parameters according to the motion model, further includes the following steps:

[0062] S31: according to the position data, motion inertia data and the surface pressure value of the worker in the process of stepping on the curve, respectively establish the original function relationship group of the position data, the motion inertia data, the surface pressure value and time, and use the original function relationship group to form an initial motion model, and determine the original simulation motion parameters according to the original motion model;

[0063] S32: using a correction mechanical foot that is restored one-to-one with the foot of a real person stepping on the curve, obtaining position data and posture data of the correction mechanical foot at different times during the correction process; and obtaining surface pressure values ​​of different areas of the curve block at different times during the correction process;

[0064] S33: establishing correction function relationship groups of the position data, the motion inertia data, the surface pressure value and time respectively according to the position data, the motion inertia data and the surface pressure value in the correction process;

[0065] S34: driving and correcting the mechanical foot through the original simulation motion parameters, comparing the correction function relationship group with the original function relationship group, and forming final simulation motion parameters according to the comparison result.

[0066] Specifically, during the manual stepping process, multiple function relationship groups of the parameter block pressure P1, acceleration V1, angular velocity W1, and spatial position D1 and any time t are obtained to form an original function relationship group S1, where:

[0067] S1(t)={P1(t),V1(t),W1(t),D1(t)};

[0068] The original motion model is formed by using the original function relationship group, and the original simulation motion parameters are determined according to the original motion model; the mechanical foot is driven and corrected by using the original simulation motion parameters, and multiple function relationship groups of the parameter block pressure P2, acceleration V2, angular velocity W2, and spatial position D2 in the correction process and any time t are obtained to form a correction function relationship group S2, where:

[0069] S2(t)={P2(t),V2(t),W2(t),D2(t)};

[0070] The correction function relationship group S2(t) is compared with the original function relationship group S1(t), and simulation motion parameters are formed according to the comparison result.

[0071] Preferably, the step S34 of driving and correcting the mechanical foot by using the original simulation motion parameters, comparing the correction function relationship group with the original function relationship group, and forming the final simulation motion parameters according to the comparison result, further includes the following steps:

[0072] S341: if the comparison error between the correction function relationship group and the original function relationship group is less than a preset error, taking the original simulation motion parameters as the final simulation motion parameters;

[0073] S342: If the comparison error between the correction function relationship group and the original function relationship group is greater than the preset error, the original simulation motion parameters are adjusted to form adjusted simulation motion parameters, and the adjusted simulation motion parameters are used to drive the correction mechanical foot until the comparison error between the adjusted correction function relationship group and the original function relationship group is less than the preset error, and the adjusted simulation motion parameters are taken as the final simulation motion parameters.

[0074] When the correction function relationship group S2(t) is compared with the original function relationship group S1(t), and the absolute value of the difference is less than the preset error, the original simulation motion parameters are taken as the final simulation motion parameters; if the correction function relationship group S2(t) is compared with the original function relationship group S1(t), and the absolute value of the difference is greater than the preset error, the original simulation motion parameters are adjusted to form adjusted simulation motion parameters, so as to reduce the absolute value of the difference between the correction function relationship group S2(t) and the original function relationship group S1(t), and make the absolute value of the difference less than the preset error, then the adjusted simulation motion parameters in this state are taken as the final simulation motion parameters; then the simulation motion parameters are compared with the parameter threshold of the real mechanical foot, and the final motion trajectory of the target point is generated according to the comparison result; and control instructions are generated according to the final simulation motion trajectory to drive the real mechanical foot. It should be noted that the preset error is a certain artificially set value.

[0075] Preferably, the step S300 of comparing the simulated motion parameters with the parameter thresholds of the real mechanical foot and generating the final motion trajectory of the target point according to the comparison result comprises the following steps:

[0076] S41: The simulated motion parameters include a simulated rotation angle, a simulated angular velocity and a simulated acceleration;

[0077] S42: comparing the simulated rotation angle with the rotation angle threshold of each leg bone of the real mechanical foot;

[0078] S43: comparing the simulated angular velocity with the angular velocity thresholds of each leg bone of the real mechanical foot;

[0079] S44: comparing the simulated acceleration with the acceleration thresholds of each leg bone of the real mechanical foot;

[0080] S45: when any one of the simulated rotation angle, the simulated angular velocity, and the simulated acceleration is greater than the corresponding parameter threshold, adjusting the simulated motion trajectory so that the simulated motion parameters of each arm in the foot model matched therewith are all less than the corresponding parameter threshold;

[0081] S46: When the simulated rotation angle, the simulated angular velocity, and the simulated acceleration are all less than the corresponding parameter thresholds, the simulated motion trajectory is used as the final motion trajectory.

[0082] Specifically, taking the real mechanical foot as a whole, each leg bone can rotate, but has different limitations, and not all leg bones can rotate 360°; the rotation angle threshold, angular velocity threshold and acceleration threshold are the maximum rotation angle, maximum acceleration and maximum acceleration achievable by the real mechanical foot, so the rotation angle threshold, angular velocity threshold and acceleration threshold can obtain relevant threshold data through multiple experiments; in other embodiments, the rotation angle threshold, angular velocity threshold and acceleration threshold can also be a certain artificially set value.

[0083] Preferably, the step S100 of obtaining the position data and motion inertia data of the feet of the actual person stepping on the bend at different times during the worker stepping on the bend; and obtaining the surface pressure values ​​of different areas of the bend block at different times during the worker stepping on the bend, comprises the following steps:

[0084] S11: The position data includes the spatial motion trajectory of the foot of the real person stepping on the curve, and the motion inertia data includes the acceleration and angular velocity of the foot of the real person stepping on the curve at different times.

[0085] Preferably, the position data includes the spatial motion trajectory of the foot of the real person who steps on the curve, and the motion inertia data includes the acceleration and angular velocity of the foot of the real person who steps on the curve at different times. Step S11 includes the following steps:

[0086] S111: attaching an inertial measurement unit and a position sensor to a target point of a real person's foot, and using the inertial measurement unit and the position sensor to collect the acceleration, angular velocity and spatial motion trajectory of the real person's foot at different times during the worker's stepping on the bending, to form a data set of acceleration and angular velocity and a spatial motion trajectory, and determine the rotation angle that changes with time based on the spatial motion trajectory.

[0087] The inertial measurement unit (IMU) includes an accelerometer and a gyroscope, which are used to collect the acceleration and angular velocity of the feet of a real person who steps on the curve at different times. The position sensor is used to collect the spatial motion trajectory of the feet of a real person who steps on the curve. The obtained acceleration, angular velocity and spatial motion trajectory are used to form a motion model, and then the simulation motion parameters are determined based on the motion model.

[0088] Accelerometers, gyroscopes and position sensors can be set on wearable devices, and workers with rich experience in stepping on the bending blocks can be selected as sample collection objects. After the workers put on the wearable devices, they start stepping on the bending blocks. The workers' feet are the real feet of the people who step on the bending blocks mentioned above. Therefore, the speed sensors, position sensors and posture sensors can be used to collect the movement changes of the workers' feet over time.

[0089] Preferably, the step of obtaining the surface pressure values ​​of different areas of the block at different times includes the following steps S200:

[0090] S21: Divide the surface of the curved block into several regions, and obtain surface pressure values ​​of different regions at different times.

[0091] The song block is evenly divided into n song block sub-blocks, and the pressure sensor is also evenly divided into n pressure sensing areas, each pressure sensing area corresponds to a song block sub-block; assuming that the time from the start of stepping on the song to the completion is recorded as T, and t is set as any moment in the stepping on the song, the time is from 0 to T, and the song block pressure P received by each pressure sensing area on the pressure sensor is continuously collected, and a function relationship group about the song block pressure P and any moment t is formed, and the acceleration V, angular velocity W, and spatial position D are combined with multiple function relationship groups at any moment t to form a total original function relationship group S1, in which,

[0092] S1(t)={P(1,t),P(2,t),...P(n,t),V1(t),W1(t),D1(t)};

[0093] The motion model is established using the original total function relationship group to determine the simulation motion parameters; that is, the entire worker stepping on the bend is restored through the state array S1, where the smaller the time interval at any moment t, the more accurate the restoration of the motion state of the stepping on the bend process. In the process of simulating the worker stepping on the bend, the real mechanical foot is made to reach a specific position at any moment t and exert the same external force on the surface of the bend block to restore the worker's stepping on the bend process.

[0094] Similarly, the parameter block pressure P2, acceleration V2, angular velocity W2, and spatial position D2 in the calibration process are respectively related to multiple function relationship groups at any time t to form the original function relationship group S2, where:

[0095] S2(t)={P2(1,t),P2(2,t),...P2(n,t),V2(t),W2(t),D2(t)};

[0096] When the child node of the mechanical foot moves, it is necessary to know how the parent node of each leg of the mechanical foot will be affected in its displacement and rotation, and to obtain the motion parameters of each leg bone of the real mechanical foot. The correction function relationship group S2(t) is compared with the original function relationship group S1(t), and the final simulation motion parameters are adjusted according to the comparison results.

[0097] The technical solution of the present invention obtains the position data and motion inertia data of the feet of a real person stepping on the bend at different times during the worker's stepping on the bend, and is used to obtain the surface pressure values ​​of different areas of the bend block at different times during the worker's stepping on the bend; then uses the surface pressure values, position data, and motion inertia data to form a motion model, and determines the simulation motion parameters according to the motion model; compares the simulation motion parameters with the parameter thresholds of the real mechanical foot, and generates the final motion trajectory of the target point according to the comparison result, and finally generates a control instruction to drive the real mechanical foot according to the final simulation motion trajectory. This series of steps solves the technical problem that artificial stepping on the bend cannot be simulated in the prior art, and realizes the function of generating a mechanical foot to reach a specified position at a certain moment after collecting motion data, thereby simulating the stepping strength and movements of the real worker, thereby greatly increasing the accuracy of the real mechanical foot in simulating artificial stepping on the bend.

[0098] In addition, to achieve the above-mentioned purpose, the present invention also proposes a control device for simulating human foot bending, which includes a data acquisition module, a simulation motion parameter module, a trajectory generation module and a driving module; the data acquisition module is used to obtain the position data and motion inertia data of the feet of a real person stepping on the bend at different times during the worker's stepping on the bend; and is used to obtain the surface pressure values ​​of different areas of the bend block at different times during the worker's stepping on the bend; the simulation motion parameter module is used to establish a motion model using surface pressure values, position data, and motion inertia data, and determine the simulation motion parameters according to the motion model; the simulation trajectory generation module is used to compare the simulation motion parameters with the parameter thresholds of the real mechanical foot, and generate the final motion trajectory of the target point according to the comparison result; the driving module is used to generate control instructions according to the final simulation motion trajectory to drive the real mechanical foot.

[0099] The control device for simulating human foot pedaling can be implemented in the form of a program and run on a computer device. The memory of the computer device can store various program modules that constitute the robot arm simulation control device, such as a data acquisition module, a simulation motion parameter module, a trajectory generation module and a drive module. The program composed of various program modules enables the processor to execute the steps of a control method for simulating human foot pedaling in various embodiments of the present application described in this specification.

[0100] Preferably, the data acquisition module includes an inertial measurement unit, a position sensor and a pressure sensor; the inertial measurement unit is used to obtain the angular velocity and acceleration of the foot of the real person stepping on the curve; the position sensor is used to obtain the spatial motion trajectory of the foot of the real person stepping on the curve; and the pressure sensor is used to obtain the surface pressure value of the curve.

[0101] Specifically, the data acquisition module can use an inertial measurement unit, a position sensor, and a pressure sensor to collect relevant data during the stepping process. The inertial measurement unit is used to measure the three-axis attitude angle (or angular velocity) and acceleration of the object. It generally includes three single-axis accelerometers and three single-axis gyroscopes. The accelerometer detects the acceleration signal of the object in the independent three axes of the carrier coordinate system, and the gyroscope detects the angular velocity signal of the carrier relative to the navigation coordinate system, measures the angular velocity and acceleration of the object in three-dimensional space, and calculates the attitude of the object; the position sensor can use a laser tracker, which can measure the distance of the target point and the horizontal and vertical deflection angles. The basic principle is to place a reflector at the target position, and the laser emitted by the laser tracking head is shot onto the reflector and reflected back to the tracking head. When the target moves, the tracking head adjusts the direction of the beam to align with the target. At the same time, the return beam is received by the detection system in the laser tracking head and is used to measure the spatial position of the target. Specifically, the reflector is attached to the target point of the foot of the real stepper, and a certain distance is set between the laser tracking head and the reflector.

[0102] Preferably, the trajectory generation module also includes a first comparison module, a second comparison module, a third comparison module, an adjustment module and a setting module; the first comparison module is used to compare the simulated rotation angle with the rotation angle threshold of each arm of the real mechanical foot; the second comparison module is used to compare the simulated angular velocity with the angular velocity threshold of each arm of the real mechanical foot; the third comparison module is used to compare the simulated acceleration with the acceleration threshold of each arm of the real mechanical foot; the adjustment module is used to adjust the simulated motion trajectory so that the simulated motion parameters of each arm in the foot model matched therewith are all less than the corresponding parameter threshold when any one of the simulated rotation angle, the simulated angular velocity and the simulated acceleration is greater than the corresponding parameter threshold; the setting module is used to use the simulated motion trajectory as the final motion trajectory when the simulated rotation angle, the simulated angular velocity and the simulated acceleration are all less than the corresponding parameter threshold, and finally generate control instructions according to the final simulated motion trajectory to drive the real mechanical foot.

[0103] In addition, to achieve the above-mentioned purpose, the present invention also proposes a computer-readable storage medium for storing a computer program, which, when executed by a processor, implements the control method for simulating human foot pedaling as described above.

[0104] The above description is only a preferred embodiment of the present invention, and does not limit the patent scope of the present invention. All equivalent structural changes made by using the contents of the present invention specification and drawings under the inventive concept of the present invention, or directly / indirectly applied in other related technical fields are included in the patent protection scope of the present invention.

Claims

1. A control method for simulating human foot pedaling, characterized in that: The following steps are involved: Obtain the position data and motion inertia data of the actual foot of the worker at different times during the process of stepping on the curve; Obtain the surface pressure values ​​of the curved block in different areas at different times when the worker is stepping on the curved block; Using surface pressure values, position data, and motion inertia data to form a motion model, and determining simulation motion parameters based on the motion model; Comparing the simulated motion parameters with the parameter thresholds of the real mechanical foot, and generating a final motion trajectory of the target point according to the comparison result; Generate control instructions to drive the real mechanical foot according to the final simulated motion trajectory; The step of forming a motion model using surface pressure values, position data, and motion inertia data, and determining simulation motion parameters according to the motion model, further includes the following steps: According to the position data, motion inertia data and the surface pressure value of the worker during the bending process, respectively establish the original function relationship group of the position data, the motion inertia data, the surface pressure value and time, and use the original function relationship group to form an initial motion model, and determine the original simulation motion parameters according to the original motion model; Using a correction mechanical foot that is restored one-to-one with the foot of a real person who steps on the curve, the position data and posture data of the correction mechanical foot at different times during the correction process are obtained; and the surface pressure values ​​of different areas of the curve block at different times during the correction process are obtained; According to the position data, motion inertia data and the surface pressure value in the correction process, respectively establishing a correction function relationship group of the position data, the motion inertia data, the surface pressure value and time; The mechanical foot is driven and corrected by the original simulation motion parameters, the correction function relationship group is compared with the original function relationship group, and the final simulation motion parameters are formed according to the comparison result.

2. The control method for simulating human foot pedaling as claimed in claim 1, characterized in that: The step of driving and correcting the mechanical foot by using the original simulation motion parameters, comparing the correction function relationship group with the original function relationship group, and forming the final simulation motion parameters according to the comparison result, further includes the following steps: If the comparison error between the correction function relationship group and the original function relationship group is less than a preset error, the original simulation motion parameters are taken as the final simulation motion parameters; If the comparison error between the correction function relationship group and the original function relationship group is greater than the preset error, the original simulation motion parameters are adjusted to form adjusted simulation motion parameters, and the adjusted simulation motion parameters are used to drive the correction mechanical foot until the comparison error between the adjusted correction function relationship group and the original function relationship group is less than the preset error, and the adjusted simulation motion parameters are taken as the final simulation motion parameters.

3. The control method for simulating human foot pedaling as claimed in claim 2, characterized in that: The step of comparing the simulated motion parameters with the parameter thresholds of the real mechanical foot and generating the final motion trajectory of the target point according to the comparison result comprises the following steps: The simulated motion parameters include simulated rotation angle, simulated angular velocity and simulated acceleration; Comparing the simulated rotation angle with the rotation angle threshold of each leg bone of the real mechanical foot; comparing the simulated angular velocity with the angular velocity thresholds of each leg bone of the real mechanical foot; Comparing the simulated acceleration with the acceleration thresholds of each leg bone of the real mechanical foot; When any one of the simulated rotation angle, simulated angular velocity, and simulated acceleration is greater than the corresponding parameter threshold, the simulated motion trajectory is adjusted so that the simulated motion parameters of each arm in the foot model matched therewith are all less than the corresponding parameter threshold; When the simulated rotation angle, simulated angular velocity, and simulated acceleration are all less than the corresponding parameter thresholds, the simulated motion trajectory is taken as the final motion trajectory.

4. The control method for simulating human foot pedaling as claimed in any one of claims 1 to 3, characterized in that: The step of obtaining the position data and motion inertia data of the feet of the worker who is actually stepping on the curve at different times during the stepping on the curve comprises the following steps: The position data includes the spatial motion trajectory of the foot of the real person who steps on the curve, and the motion inertia data includes the acceleration and angular velocity of the foot of the real person who steps on the curve at different times.

5. The control method for simulating human foot pedaling as claimed in claim 4, characterized in that: The position data includes the spatial motion trajectory of the foot of the real person who steps on the curve, and the motion inertia data includes the acceleration and angular velocity of the foot of the real person who steps on the curve at different times, including the following steps: The inertial measurement unit and the position sensor are attached to the target point of the foot of the real person who is bending the bends. The acceleration, angular velocity and spatial motion trajectory of the foot of the real person who is bending the bends at different times during the worker's bending process are collected using the inertial measurement unit and the position sensor to form a data set of acceleration and angular velocity and a spatial motion trajectory, and the rotation angle that changes with time is determined based on the spatial motion trajectory.

6. The control method for simulating human foot pedaling as claimed in any one of claims 1 to 3, characterized in that: The step of obtaining the surface pressure values ​​of different areas of the block at different times comprises the following steps: The surface of the curved block is divided into several regions, and the surface pressure values ​​of different regions at different times are obtained.

7. A control device simulating human foot pedaling, characterized in that: include: The data acquisition module is used to obtain the position data and motion inertia data of the feet of the actual workers at different times during the process of stepping on the curve; And it is used to obtain the surface pressure values ​​of different areas of the curved block at different times when the workers are stepping on the curved block; A simulation motion parameter module is used to establish a motion model using surface pressure values, position data, and motion inertia data, and to determine simulation motion parameters based on the motion model; A simulation trajectory generation module, used for comparing the simulation motion parameters with the parameter thresholds of the real mechanical foot, and generating a final motion trajectory of the target point according to the comparison result; The driving module is used to generate control instructions according to the final simulated motion trajectory to drive the real mechanical foot.

8. The control device for simulating human foot pedaling as claimed in claim 7, characterized in that: The data acquisition module includes an inertial measurement unit, a position sensor and a pressure sensor; the inertial measurement unit is used to obtain the angular velocity and acceleration of the feet of the real person who steps on the curve; the position sensor is used to obtain the spatial motion trajectory of the feet of the real person who steps on the curve; and the pressure sensor is used to obtain the surface pressure value of the curve block.

9. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the control method for simulating human foot pedaling as described in any one of claims 1 to 6 is implemented.