CN112545211B - Storage unit positioning method, system and device, storage medium and storage device - Google Patents

Storage unit positioning method, system and device, storage medium and storage device Download PDF

Info

Publication number
CN112545211B
CN112545211B CN202011432611.5A CN202011432611A CN112545211B CN 112545211 B CN112545211 B CN 112545211B CN 202011432611 A CN202011432611 A CN 202011432611A CN 112545211 B CN112545211 B CN 112545211B
Authority
CN
China
Prior art keywords
positioning point
linear equation
positioning
equation
storage
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202011432611.5A
Other languages
Chinese (zh)
Other versions
CN112545211A (en
Inventor
王瑞刚
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong Zhiyuan Robot Technology Co Ltd
Original Assignee
Guangdong Zhiyuan Robot Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangdong Zhiyuan Robot Technology Co Ltd filed Critical Guangdong Zhiyuan Robot Technology Co Ltd
Priority to CN202011432611.5A priority Critical patent/CN112545211B/en
Publication of CN112545211A publication Critical patent/CN112545211A/en
Application granted granted Critical
Publication of CN112545211B publication Critical patent/CN112545211B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47BTABLES; DESKS; OFFICE FURNITURE; CABINETS; DRAWERS; GENERAL DETAILS OF FURNITURE
    • A47B81/00Cabinets or racks specially adapted for other particular purposes, e.g. for storing guns or skis

Abstract

The application discloses a storage unit positioning method, a system, a device, a storage medium and a storage device, which are applied to the storage unit positioning of a storage cabinet comprising a plurality of storage units, and the method comprises the following steps: obtaining coordinates of a first positioning point, a second positioning point and a third positioning point of the storage cabinet, and determining a first linear equation according to the coordinates of the first positioning point and the second positioning point; determining a second linear equation according to the coordinates of the first positioning point and the third positioning point; determining a first linear equation set according to the first linear equation, the coordinates of the third positioning point and the row and column parameters; determining a second linear equation set according to the second linear equation, the coordinates of the second positioning point and the row and column parameters; and positioning the storage units of the storage cabinet according to the intersection points of the third linear equation and the fourth linear equation. The method and the device can be widely applied to the technical field of automation.

Description

Storage unit positioning method, system and device, storage medium and storage device
Technical Field
The application relates to automation technology, in particular to a storage unit positioning method, a storage unit positioning system, a storage unit positioning device, a storage medium and a storage device.
Background
With the development of industrial automation technology, many storage and manufacturing scenarios have storage cabinets for storing products or intermediate products, and then the products are stored or taken out by an automated robot (e.g., a mechanical arm, etc.). Generally, these storage cabinets are provided with a plurality of storage units (also called storage lattices), the storage lattices are composed of a plurality of baffles which are staggered transversely and vertically, because the baffles are generally made of rigid materials, if deviation exists in the installation process, each storage unit of the whole storage cabinet is deformed, the storage surface of each storage unit is usually deformed into a parallelogram from a rectangle, and due to the rigid characteristic of the baffles, the deformation is transmitted to each storage unit, and the angular deformation of each storage unit is generally the same.
In the related art, two-point method is generally adopted to position the storage units of the storage cabinet, the principle is that two vertexes of the storage surface of the storage cabinet are taken as positioning points, and the storage surface of each storage unit of the storage cabinet is assumed to be a standard rectangle for calculation.
Disclosure of Invention
In view of this, the present application aims to: the storage unit positioning method, the storage unit positioning system, the storage device, the storage medium and the storage device are provided, so that the positioning accuracy of the storage unit is improved.
In a first aspect, an embodiment of the present application provides:
a storage unit positioning method applied to the positioning of a storage unit of a storage cabinet comprising a plurality of storage units, the method comprises the following steps:
acquiring coordinates of a first positioning point of the locker, coordinates of a second positioning point of the locker, coordinates of a third positioning point of the locker and row and column parameters, wherein the first positioning point and the second positioning point are positioned on a first baffle of the locker, the first positioning point and the third positioning point are positioned on a second baffle of the locker, and the first positioning point, the second positioning point and the third positioning point are positioned on a storage surface of the locker;
determining a first linear equation according to the coordinates of the first positioning point and the coordinates of the second positioning point;
determining a second linear equation according to the coordinates of the first positioning point and the coordinates of the third positioning point;
determining a first linear equation set according to the first linear equation, the coordinates of a third positioning point and the row and column parameters, wherein the first linear equation set comprises a plurality of third linear equations parallel to the first linear equation;
determining a second linear equation set according to the second linear equation, the coordinates of the second positioning point and the row and column parameters; the second linear equation set comprises a plurality of fourth linear equations parallel to the second linear equations;
and positioning the storage units of the storage cabinet according to the intersection point of the third linear equation and the fourth linear equation.
In some embodiments, the first baffle and the second baffle are both baffles located at the edge of the storage cabinet, the second positioning point is located at the first end of the first baffle, the first positioning point is located at the second end of the first baffle, the second end of the first baffle is connected with the first end of the second baffle, the third positioning point is located at the second end of the second baffle, and the row and column parameters comprise a set number of rows and a set number of columns;
determining a first linear equation set according to the first linear equation, the coordinates of the third positioning point and the row and column parameters, including:
determining a first distance between the coordinates of the third positioning point and the first linear equation;
determining the first linear equation set according to the first linear equation, the first distance and the set line number;
determining a second line equation set according to the second line equation, the coordinate of the second positioning point and the row and column parameters, including:
determining a second distance between the coordinates of the second positioning point and the second linear equation;
and determining the second linear equation set according to the second linear equation, the second distance and the set column number.
In some embodiments, each of said third linear equations in said first set of linear equations corresponds to a different cross bar of said cabinet; each fourth linear equation in the second linear equation set respectively corresponds to a different vertical baffle of the storage cabinet.
In some embodiments, the first linear equation is determined by a first X coefficient, a first Y coefficient, and a first intercept; the second linear equation is determined by a second X coefficient, a second Y coefficient and a second intercept;
determining the first linear equation set according to the first linear equation, the first distance and the set line number, including:
determining each third linear equation according to the first X coefficient, the first Y coefficient, the first intercept and the set row number;
wherein each of the third linear equations is determined by the first X coefficient, the first Y coefficient, and a third intercept corresponding to the third linear equation, and the third intercept corresponding to the third linear equation is determined by:
calculating a square root of a sum of squares of a first X coefficient and the first Y coefficient as a first value;
calculating the number of lines corresponding to the third linear equation minus one to be used as a second value;
dividing the difference between the first distance and the preset line number minus one to obtain a third value;
taking the sum of the product of the first value, the second value and the third value and the first intercept as a third intercept corresponding to the third linear equation;
determining the second line equation set according to the second line equation, the second distance and the set column number, including:
determining each fourth linear equation according to the second X coefficient, the second Y coefficient, the second intercept and the set column number;
wherein each of the fourth linear equations is determined by the second X coefficient, the second Y coefficient and a fourth intercept of the fourth linear equation, and the fourth intercept corresponding to the fourth linear equation is determined by the following steps:
calculating a square root of a sum of squares of a second X coefficient and the second Y coefficient as a fourth value;
calculating the number of columns corresponding to the fourth linear equation minus one to be used as a fifth value;
dividing the second distance by the difference obtained by subtracting one from the preset column number to obtain a sixth value;
and determining the sum of the product of the fourth value, the fifth value and the sixth value and a second intercept as a fourth intercept corresponding to the fourth linear equation.
In some embodiments, said positioning the storage cells of the locker according to the intersection of the third and fourth line equations comprises:
and determining the straight line intersection point of each third straight line equation and all fourth straight line equations, and associating all straight line intersection points to the storage units of the locker.
In some embodiments, the first X coefficient is determined from a difference between a Y coordinate of the second positioning point and a Y coordinate of the first positioning point; the first Y coefficient is determined according to the difference between the X coordinate of the first positioning point and the X coordinate of the second positioning point; the second X coefficient is determined according to the difference between the Y coordinate of the third positioning point and the Y coordinate of the first positioning point, and the second Y coefficient is determined according to the difference between the X coordinate of the first positioning point and the X coordinate of the third positioning point.
In a second aspect, embodiments of the present application provide:
a storage unit positioning system for positioning storage units of a storage cabinet comprising a plurality of said storage units, said system comprising:
the system comprises an acquisition unit, a storage unit and a control unit, wherein the acquisition unit is used for acquiring the coordinates of a first positioning point of a locker, the coordinates of a second positioning point of the locker, the coordinates of a third positioning point of the locker and row and column parameters, the first positioning point and the second positioning point are positioned on a first baffle of the locker, the first positioning point and the third positioning point are positioned on a second baffle of the locker, and the first positioning point, the second positioning point and the third positioning point are positioned on the storage surface of the locker;
the first equation determining unit is used for determining a first linear equation according to the coordinates of the first positioning point and the coordinates of the second positioning point;
the second equation determining unit is used for determining a second linear equation according to the coordinates of the first positioning point and the coordinates of the third positioning point;
the first equation set determining unit is used for determining a first equation set according to the first linear equation, the coordinates of a third positioning point and the row and column parameters, wherein the first equation set comprises a plurality of third linear equations parallel to the first linear equation;
the second equation set determining unit is used for determining a second linear equation set according to the second linear equation, the coordinates of the second positioning point and the row and column parameters; the second linear equation set comprises a plurality of fourth linear equations parallel to the second linear equation;
and the positioning unit is used for positioning the storage unit of the storage cabinet according to the intersection point of the third linear equation and the fourth linear equation.
In a third aspect, an embodiment of the present application provides:
a storage unit positioning device comprising:
a memory for storing a program;
and the processor is used for loading the program to execute the storage unit positioning method.
In a fourth aspect, embodiments of the present application provide:
a computer-readable storage medium, in which a program is stored, which, when executed by a processor, implements the storage unit positioning method described above.
In a fifth aspect, an embodiment of the present application provides:
a storage device, comprising:
the storage cabinet comprises a plurality of storage units;
the processor is used for acquiring the identification of the target storage unit and inquiring the position of the target storage unit according to the identification of the target storage unit, wherein the position is determined by the storage unit positioning method;
and the actuator is used for storing or taking out the articles according to the coordinates of the target storage unit according to the control instruction of the processor.
According to the storage cabinet positioning method and device, the first positioning point, the second positioning point and the third positioning point which are positioned on the two crossed baffles are selected to be positioned based on a three-point positioning mode, and the position of each storage unit can be accurately determined under the condition that the storage cabinet is deformed by combining the deformation characteristic of the storage cabinet, so that the situation that automatic actuators such as mechanical arms cannot smoothly complete storage and taking tasks due to positioning errors can be reduced, and the reliability of automatic equipment is improved.
Drawings
In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings required to be used in the description of the embodiments are briefly introduced below, and it is obvious that the drawings in the description below are some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings based on the drawings without creative efforts.
FIG. 1 is a schematic view of a cabinet undergoing deformation;
fig. 2 is a flowchart of a storage unit positioning method according to an embodiment of the present application;
FIG. 3 is a schematic diagram illustrating a distribution of locating points of a locker in an XY coordinate system according to an embodiment of the present application;
FIG. 4 is a schematic view illustrating positioning of an nth row and an nth column of storage units according to an embodiment of the present disclosure;
FIG. 5 is a schematic diagram of distribution of linear equations in an XY coordinate system provided in accordance with an embodiment of the present application;
FIG. 6 is a schematic diagram illustrating a distribution of location points of the locker in an XY coordinate system according to the embodiment of the present application;
FIG. 7 is a schematic structural view of a storage device according to an embodiment of the present disclosure;
fig. 8 is a block diagram of a storage unit positioning system according to an embodiment of the present application.
Detailed Description
In order to make the purpose, technical solutions and advantages of the present application clearer, the technical solutions of the present application will be clearly and completely described below through embodiments with reference to the accompanying drawings in the embodiments of the present application, and it is obvious that the described embodiments are some embodiments of the present application, but not all embodiments. All other embodiments obtained by a person of ordinary skill in the art based on the embodiments in the present application without making any creative effort belong to the protection scope of the present application.
In the embodiment of the present application, the storage cabinet described herein may be a storage cabinet sold separately as a product, or may be a part of other products, and it should be understood that the storage cabinet in the embodiment of the present application is composed of a plurality of baffles which are staggered with each other, and generally, the storage cabinet in the embodiment of the present application is divided into a plurality of storage units with rectangular access surfaces by the baffles in an ideal installation state. Wherein the access surface is an open surface and thus accessible by a device such as a robotic arm. Since the storage cabinet described in the embodiment of the present application is made of rigid panels, when the storage cabinet is installed in a different way (for example, two panels that should be vertically installed form an included angle of 85 ° in actual installation), the storage surfaces of all the storage units are deformed, and the deformation of each storage unit is the same or proportional. The deformation process is shown in FIG. 1, the storage cabinet storage area 110 is defined by a dashed line, which represents the storage area when the cabinet is normally installed, and the storage cabinet storage area 120 is defined by a solid line, which represents the storage area when the cabinet is installed with some deviation. In the related art, the calculation is performed by using the point P1 and the point P2, and the transverse coordinates are calculated by using Xp2-Xp1, and the transverse position of the inner storage unit is calculated according to the number of the storage units in each row. Similarly, longitudinal coordinates are calculated by using Yp2-Yp1, and the longitudinal position of each inner storage unit is calculated according to the number of the storage units in each row. However, as can be seen from fig. 1, although the deviation between each corresponding cell is not as large as that in fig. 1 in practical application, it can be understood that even if there is a slight deviation, in the case that there are many storage units, the storage units are relatively small, or the fault tolerance of the robot arm is relatively low, the accumulation of errors still easily causes the automatic actuator such as the robot arm to fail to complete the task normally. The horizontal and vertical (YX) coordinates referred to in this embodiment are all system coordinates of the automation device that performs the storing task as a reference system.
To this end, referring to fig. 2, the present embodiment discloses a storage unit positioning method applied to the storage unit positioning of a storage cabinet including a plurality of storage units, and after the positioning is completed, an automated executor such as a robot arm may perform the storage and retrieval of articles based on the positioning of the storage units.
In this embodiment, the method comprises the steps of:
step 210, obtaining coordinates of a first positioning point of the storage cabinet, coordinates of a second positioning point of the storage cabinet, coordinates of a third positioning point of the storage cabinet and row and column parameters, wherein the first positioning point and the second positioning point are located on a first baffle of the storage cabinet, the first positioning point and the third positioning point are located on a second baffle of the storage cabinet, and the first positioning point, the second positioning point and the third positioning point are located on a storage surface of the storage cabinet.
Referring to fig. 3, the baffle plate in this embodiment includes a bearing plate and a side plate which form the storage cabinet, the bearing plate is generally arranged transversely, and the side plate is arranged perpendicularly to the bearing plate, i.e. vertically. In this embodiment, the first positioning point a is located at the lower left corner of the storage cabinet, and the positioning point B is located at the lower right corner of the storage cabinet, and it can be seen that the first positioning point a and the second positioning point B are both located on the horizontal baffle at the bottom of the storage cabinet and located on the access surface of the storage cabinet. And the third positioning point C is positioned at the upper left corner, and the first positioning point A and the third positioning point C are positioned on the leftmost transverse baffle of the storage cabinet. Due to the special structure of the storage cabinet, the position of the storage unit can be determined based on the first positioning point A, the second positioning point B, the third positioning point and the row and column parameters. It should be understood that the coordinates of the positioning point may be determined based on calibration parameters of a camera after being photographed by the camera of the automation device, or may be manually calibrated.
And step 220, determining a first linear equation according to the coordinate of the first positioning point and the coordinate of the second positioning point.
In this embodiment, a first linear equation passing through the first positioning point a and the second positioning point B can be determined by determining a straight line by two points through the coordinates (Xa, Ya) of the first positioning point and the coordinates (Xb, Yb) of the second positioning point, and specifically, the equation can be described by the following equation:
lab: a1x + B1y + C1 ═ 0, where A1 ═ Yb-Ya; b1 ═ Xa-Xb; c1 ═ Xb Ya-Xa Yb. The first X coefficient A1 is determined according to the difference between the Y coordinate Yb of the second positioning point and the Y coordinate Ya of the first positioning point; the first Y coefficient B1 is determined from the difference between the X coordinate Xa of the first localization point and the X coordinate Xb of the second localization point.
And step 230, determining a second linear equation according to the coordinate of the first positioning point and the coordinate of the third positioning point.
Likewise, a second equation of a straight line passing through the first positioning point a and the second positioning point B can be determined by the coordinates (Xa, Ya) of the first positioning point and the coordinates (Xc, Yc) of the third positioning point, and specifically, the equation can be described by the following equation:
and Lac: A2X + B2Y + C2 ═ 0, where A2 ═ Yc-Ya; b2 ═ Xa-Xc; c2 ═ Xc Ya-Xa ═ Yc. The second X coefficient A2 is determined according to the difference between the Y coordinate Yc of the third positioning point and the Y coordinate Ya of the first positioning point, and the second Y coefficient B2 is determined according to the difference between the X coordinate Xa of the first positioning point and the X coordinate Xc of the third positioning point.
And 240, determining a first linear equation set according to the first linear equation, the coordinates of the third positioning point and the row and column parameters, wherein the first linear equation set comprises a plurality of third linear equations parallel to the first linear equation.
It should be understood that in some embodiments, the row and column parameters include a predetermined number of rows and a predetermined number of columns, and as the three positioning points are located at the vertex of the storage cabinet, the row and column of the storage cabinet only need to be known, that is, the location of the storage unit in each row or column can be determined in an equal division manner. In the embodiment, the method for constructing the first linear equation set is to construct a linear equation parallel to the first linear equation, and the method conforms to the deformation characteristic of the storage cabinet. Assuming that the size of each storage unit is the same, the intercept of the straight line equation of each line may be calculated by calculating the distance d1 from the third positioning point C to the first straight line equation Lab and then calculating from the maximum number of lines.
As shown in fig. 4, the specific calculation process of the distance d1 is as follows:
Figure BDA0002827108060000071
the Ny-th line equation is expressed as: a1x + B1y + C1ny ═ 0.
Figure BDA0002827108060000072
Where C1Ny represents the intercept of the line-of-line equation of the Ny row and My represents the maximum number of rows.
Step 250, determining a second linear equation set according to a second linear equation, the coordinates of the second positioning point and the row and column parameters; and the second linear equation set comprises a plurality of fourth linear equations parallel to the second linear equation.
Similarly, referring to fig. 4, the distance d2 from the second anchor point B to the second line equation Lac may be calculated first, and then the fourth line equation of each column may be calculated according to the maximum number of columns.
Figure BDA0002827108060000073
The equations in column Nx are expressed as: a2x + B2y + C2nx is 0.
Wherein the content of the first and second substances,
Figure BDA0002827108060000074
c2Nx denotes the intercept of the fourth line equation for the Nx column, and Mx denotes the maximum number of columns.
Based on the above two steps, we can obtain a first set of linear equations and a second set of linear equations.
And step 260, positioning the storage units of the storage cabinet according to the intersection points of the third linear equation and the fourth linear equation.
When the storage units in a certain row and a certain column need to be searched, the positioning points can be obtained only by calculating the intersection points of the corresponding third linear equation and the fourth linear equation. For example, the storage cell in the nth row and the nth column is positioned only by solving the intersection of Lnx and Lny.
For example, referring to fig. 5, the positioning point of the storage unit in the second row and the second column needs to be obtained, and only the intersection point of the linear equation l2y and the linear equation l2x needs to be calculated, so that the positioning point can be positioned at the lower left corner of the storage unit in the second row and the second column. Of course, the lower left corner of the storage unit is selected as the positioning point in this embodiment, but actually, the upper right corner, the lower right corner, the upper left corner or the geometric center of the storage unit can be used as the positioning point. It will be appreciated that the first set of line equations comprises in this example the third set of line equations l1y, l2y, l3y and l4y, and the second set of line equations comprises the fourth set of line equations l1x, l2x, l3x and l4 x.
According to the embodiment, the three-point positioning mode is more accurate relative to the two-point positioning mode, and the deformation condition of the storage cabinet can be calculated in the storage cabinet positioning scene by the three-point positioning mode, so that the possibility of operation failure of the mechanical arm can be reduced, and the reliability of the automatic equipment is improved.
With reference to fig. 3 and 6, the present embodiment provides another variation, and the scheme depicted in fig. 6 is a variation of the scheme in fig. 3. The embodiment of figure 6 differs from the embodiment of figure 3 in that the three points of attachment in figure 6 are not located at the edge flaps of the cabinet but at the central flap, but in fact the attachment of the storage units can be achieved as long as three points are located at the two intersecting flaps and one point is located at the junction of the two intersecting flaps. The difference from the embodiment of fig. 3 is that in the embodiment of fig. 6, an operation also needs to be performed according to the positional relationship between three points. For example, a linear equation Lab may be determined according to the first positioning point a and the second positioning point B, and at this time, a linear equation parallel to the Lab and passing through the third positioning point C is constructed. Similarly, all column equations can be constructed based on the same principle. Specifically, a line equation Lac may be determined from the first positioning point a and the third positioning point C, and then a line equation passing through the point B and parallel to the line equation Lac may be constructed, and since the maximum number of columns is known and the point a and the point B are known to be separated by two storage units, all the column line equations may be calculated, and under the teaching of the above embodiment, a person skilled in the art may determine a line equation describing the position of each barrier from the three positioning points satisfying the above conditions according to geometric knowledge and position the storage units based on the intersection points of the line equations.
In some embodiments, the first baffle and the second baffle are both baffles located at the edge of the storage cabinet, the second positioning point is located at the first end of the first baffle, the first positioning point is located at the second end of the first baffle, the second end of the first baffle is connected with the first end of the second baffle, the third positioning point is located at the second end of the second baffle, and the row and column parameters include the set number of rows and the set number of columns.
Specifically, in the embodiment, the scheme shown in fig. 3 is adopted, where the first location point a is located at the lower left corner of the locker, the second location point B is located at the lower right corner of the locker, and the third location point C is located at the upper left corner of the locker. It will be appreciated that the first panel is a bearing plate of the cabinet base, which may also be called a transverse panel, and the second panel is a vertical panel at the left edge, and in this embodiment, the first and second panels are vertical in the normal installed condition, and form an acute angle in the event of installation errors.
According to a first linear equation Lab: the coordinates of A1x + B1y + C1, 0, the coordinates of the third positioning point C, and the row and column parameters determine a first set of linear equations, which includes:
determining the coordinates of the third positioning point C and a first linear equation Lab: a first distance d1 between A1x + B1y + C1 ═ 0; wherein, the first and the second end of the pipe are connected with each other,
Figure BDA0002827108060000081
according to a first linear equation Lab: and A1x + B1y + C1 is 0, the first distance and the set row number My, and a first linear equation set is determined. As shown in FIG. 5, the first set of line equations includes the third line equations l1y, l2y, l3y, and l4 y.
According to a second linear equation Lac: a2x + B2y + C2, where 0, the coordinates of the second positioning point, and the row and column parameters determine a second set of line equations, which includes:
determining the coordinate B of the second positioning point and a second linear equation Lac: a second distance d2 between A2x + B2y + C2 ═ 0; wherein, the first and the second end of the pipe are connected with each other,
Figure BDA0002827108060000091
according to a second linear equation Lac: a2x + B2y + C2 is 0, the second distance, and the set column number Mx, and determines a second set of line equations. As shown in FIG. 5, the second set of line equations includes fourth line equations l1x, l2x, l3x, and l4 x.
In some embodiments, the first linear equation is determined by a first X coefficient a1, a first Y coefficient B1, and a first intercept C1; the second line equation is determined by a second X coefficient A2, a second Y coefficient B2, and a second intercept C2.
Specifically, the first linear equation may be expressed as Lab: a1x + B1y + C1 is 0, and the second line equation can be expressed as Lac: a2x + B2y + C2 is 0.
According to a first linear equation Lab: a1x + B1y + C1 is 0, the first distance d1 and the set number of rows My, and determines a first set of linear equations, including:
determining each third linear equation according to the first X coefficient A1, the first Y coefficient B1, the first intercept C1 and the set number of rows;
wherein each third linear equation is determined by the first X coefficient a1, the first Y coefficient B1 and the third intercept C1Ny corresponding to the third linear equation, and the Ny-line linear equation is expressed as: a1x + B1y + C1ny ═ 0.
The third intercept C1ny corresponding to the third line equation is determined by:
the square root of the sum of the squares of the first X coefficient A1 and the first Y coefficient B1 is calculated as a first value, i.e.
Figure BDA0002827108060000092
The number of lines corresponding to the third linear equation minus one, i.e., (Ny-1), is calculated as the second value.
The difference between the first distance and the preset line number minus one is divided to obtain a third value, i.e. d1/(My-1), where My represents the maximum line number.
And taking the sum of the product of the first value, the second value and the third value and the first intercept C1 as a third intercept C1ny corresponding to the third straight-line equation. Namely that
Figure BDA0002827108060000093
According to a second linear equation Lac: a2x + B2y + C2 is equal to 0, the second distance d2 and the set number of columns Mx, and a second set of line equations is determined, including:
determining each fourth straight-line equation according to the second X coefficient A2, the second Y coefficient B2, the second intercept C2 and the set column number Mx;
wherein each fourth line equation is determined by a second X coefficient A2, a second Y coefficient B2, and a fourth intercept C2Nx of the fourth line equation, and the equation in column Nx is expressed as: a2x + B2y + C2nx ═ 0.
The fourth intercept C2nx for the fourth line equation is determined by:
the square root of the sum of the squares of the second X coefficient A2 and the second Y coefficient B2 is calculated as a fourth value, i.e.
Figure BDA0002827108060000101
The number of columns Nx corresponding to the fourth straight-line equation minus one is calculated as a fifth value, i.e., (Nx-1).
The second distance d2 is divided by the difference between the preset number of columns Mx minus one to obtain a sixth value, d2/(Mx-1), Mx representing the maximum number of columns,
and determining the sum of the product of the fourth value, the fifth value and the sixth value and the second intercept C2 as a fourth intercept C2nx corresponding to the fourth straight-line equation. Wherein the content of the first and second substances,
Figure BDA0002827108060000102
the embodiment has simple calculation process and less required operation parameters, and can accurately position the storage unit by utilizing the specific deformation of the storage cabinet.
In some embodiments, each third linear equation in the first set of linear equations corresponds to a different cross bar of the locker; and each fourth linear equation in the second linear equation set respectively corresponds to different vertical baffles of the storage cabinet.
Referring to FIG. 5, the first set of linear equations includes the third linear equations l1y, l2y, l3y and l4y, which correspond to the four cross bars of the cabinet from bottom to top, respectively. The second set of line equations includes the third line equations l1x, l2x, l3x and l4x, which correspond to the four vertical rails of the cabinet, respectively, from left to right.
In some embodiments, positioning the storage cells of the locker according to the intersection of the third and fourth line equations comprises:
and determining the straight line intersection point of each third straight line equation and all fourth straight line equations, and associating all straight line intersection points to the storage units of the storage cabinet.
In the embodiment, referring to fig. 5, the position of each storage unit can be represented by the coordinates of the lower left corner of the storage unit, for example, the position of the storage unit in the first row and the first column can be located by calculating the intersection point of l1x and l1 y. By calculating the intersection point of l2x and l3y, the position of the storage unit in the third row and the second column can be obtained. Therefore, the intersection points of all the third linear equations and the fourth linear equations can be mapped to the cells by establishing a mapping relation. For example, the intersection of the line equations in the P-th row and Q-th column is represented by (P, Q), and the coordinates of the corresponding intersection are (xpq, ypq) so that each intersection corresponds to a coordinate value. After the initialized positioning is completed, the corresponding positioning coordinates can be inquired based on the row and column where the storage units needing to be positioned are located.
Referring to fig. 7, the present embodiment discloses a storage device, including:
the storage cabinet 610 includes a plurality of storage units. The cells may store items 630 therein. It should be understood that, in this embodiment, the locker is composed of a plurality of rigid baffles, forming a plurality of storage units, and when the locker is installed inaccurately and deforms, each storage unit deforms proportionally.
And the processor (not shown) is used for acquiring the identification of the target storage unit, inquiring the position of the target storage unit according to the identification of the target storage unit, wherein the position is determined by the storage unit positioning method. Typically, the identification of the target storage unit is entered by a user, or by an upstream program. In particular, an upstream program may refer to a program that manages the deposit of items, such as a warehouse management program. The identification of the storage unit is used for distinguishing the storage unit, and the position positioned based on the storage unit positioning method can be associated with the identification of the storage unit, so that the corresponding position coordinate can be obtained by looking up a table by obtaining the identification of the storage unit. For example, in fig. 7, row parameters are represented by P1 to P4, column parameters are represented by Q1 to Q4, and the first row and the first column can be represented by (P1, Q1).
When the scheme is applied to a selling device of articles (such as dishes), the identification of the target storage unit can be determined according to a purchase order, and the specific acquisition mode can comprise the following steps: obtaining a purchase order for an item (e.g., a dish); determining a required material according to the item type (an item type may correspond to at least one material) included in the purchase order; according to a preset material storage table (the table is used for indicating the row and column stored in any material, such as row 2 and column 2), the row and column corresponding to the required material (in this embodiment, the row and column correspond to the identification of the target storage unit), and then the actual coordinate position corresponding to the row and column can be determined by using the intersection point of the third linear equation and the fourth linear equation, so that the device can drive the clamping jaws to be accurately positioned to the corresponding position to clamp the magazine (container for carrying the required material) according to the actual coordinate position.
And the actuator 620 is used for storing or taking out the articles according to the coordinates of the target storage unit according to the control instruction of the processor. In this embodiment, the actuator 620 may be a mechanical arm or a robot, which has a function of holding an article and can place or take the article into or out of the storage unit.
In some specific examples, for example, a dining robot, processed finished products or semi-finished products are generally placed in a storage cabinet to achieve the functions of heat preservation, refrigeration or temporary storage. For example, a topping thermal cabinet of a rice flour vending machine is one of the application scenarios of the above embodiment. The rice flour vending machine topping heat preservation cabinet has 10 layers of topping box storage positions, each layer has 4 rows, and 40 topping box storage positions are total, when the equipment operates, the clamping jaw needs to be driven by a two-shaft mechanical module to be accurately positioned to the corresponding position to clamp the material box, and if each position is set one by one, the equipment debugging time is delayed, and the equipment is a complex process for a debugging engineer. As the storage positions of the material boxes are 10 layers and 4 rows, the storage position of each material box is positioned by using the method of the embodiment, so that the debugging difficulty of the equipment is greatly reduced, and the debugging time is shortened. Referring to fig. 8, the present embodiment discloses a storage unit positioning system, which is applied to positioning storage units of a storage cabinet comprising a plurality of storage units, and the system comprises:
the storage device comprises an obtaining unit 710 for obtaining coordinates of a first positioning point of the storage cabinet, coordinates of a second positioning point of the storage cabinet, coordinates of a third positioning point of the storage cabinet and row and column parameters, wherein the first positioning point and the second positioning point are located on a first baffle of the storage cabinet, the first positioning point and the third positioning point are located on a second baffle of the storage cabinet, and the first positioning point, the second positioning point and the third positioning point are located on a storage surface of the storage cabinet;
a first equation determining unit 720, configured to determine a first linear equation according to the coordinates of the first positioning point and the coordinates of the second positioning point;
the second equation determining unit 730 is configured to determine a second linear equation according to the coordinate of the first positioning point and the coordinate of the third positioning point;
the first equation set determining unit 740 is configured to determine a first equation set according to the first linear equation, the coordinates of the third positioning point, and the row and column parameters, where the first equation set includes a plurality of third linear equations parallel to the first linear equation;
a second equation set determining unit 750, configured to determine a second equation set according to the second linear equation, the coordinates of the second positioning point, and the row and column parameters; the second linear equation set comprises a plurality of fourth linear equations parallel to the second linear equations;
and the positioning unit 760 is used for positioning the storage units of the storage cabinet according to the intersection point of the third linear equation and the fourth linear equation.
The embodiment discloses a storing unit positioner includes:
a memory for storing a program;
and the processor is used for loading a program to execute the storage unit positioning method.
The embodiment discloses a computer-readable storage medium, wherein a program is stored in the computer-readable storage medium, and when the program is executed by a processor, the storage unit positioning method is realized.
From the above description of the embodiments, it is obvious for those skilled in the art that the present application can be implemented by software and necessary general hardware, and certainly can be implemented by hardware, but the former is a better embodiment in many cases. Based on such understanding, the technical solutions of the present application may be embodied in the form of a software product, which may be stored in a computer-readable storage medium, such as a floppy disk, a Read-Only Memory (ROM), a Random Access Memory (RAM), a FLASH Memory (FLASH), a hard disk or an optical disk of a computer, and includes several instructions for enabling a computer device (which may be a personal computer, a server, or a network device) to execute the methods of the embodiments of the present application.
It is to be noted that the foregoing is only illustrative of the presently preferred embodiments and application of the principles of the present invention. It will be understood by those skilled in the art that the present application is not limited to the particular embodiments illustrated herein, and that various obvious changes, rearrangements and substitutions may be made therein by those skilled in the art without departing from the scope of the application. Therefore, although the present application has been described in more detail with reference to the above embodiments, the present application is not limited to the above embodiments, and may include other equivalent embodiments without departing from the spirit of the present application, and the scope of the present application is determined by the scope of the appended claims.

Claims (9)

1. A storage unit positioning method is characterized in that the method is applied to the storage unit positioning of a storage cabinet comprising a plurality of storage units, and comprises the following steps:
obtaining coordinates of a first positioning point of the locker, coordinates of a second positioning point of the locker, coordinates of a third positioning point of the locker and row and column parameters, wherein the first positioning point and the second positioning point are positioned on a first baffle of the locker, the first positioning point and the third positioning point are positioned on a second baffle of the locker, the first positioning point, the second positioning point and the third positioning point are positioned on a storage surface of the locker, the first baffle and the second baffle are both baffles positioned at the edge of the locker, the second positioning point is positioned at a first end of the first baffle, the first positioning point is positioned at a second end of the first baffle, a second end of the first baffle is connected with a first end of the second baffle, and the third positioning point is positioned at a second end of the second baffle, the row and column parameters comprise a set row number and a set column number;
determining a first linear equation according to the coordinates of the first positioning point and the coordinates of the second positioning point, and determining a first linear equation set according to the first linear equation, the coordinates of the third positioning point and the row and column parameters includes:
determining a first distance between the coordinates of the third positioning point and the first linear equation;
determining the first linear equation set according to the first linear equation, the first distance and the set line number;
determining a second linear equation according to the coordinates of the first positioning point and the coordinates of the third positioning point, wherein determining a second linear equation set according to the second linear equation, the coordinates of the second positioning point and the row and column parameters comprises:
determining a second distance between the coordinates of the second positioning point and the second linear equation;
determining the second linear equation set according to the second linear equation, the second distance and the set column number;
determining a first linear equation set according to the first linear equation, the coordinates of the third positioning point and the row and column parameters, wherein the first linear equation set comprises a plurality of third linear equations parallel to the first linear equation;
determining a second linear equation set according to the second linear equation, the coordinates of the second positioning point and the row and column parameters; the second linear equation set comprises a plurality of fourth linear equations parallel to the second linear equations;
and positioning the storage units of the storage cabinet according to the intersection point of the third linear equation and the fourth linear equation.
2. The storage module positioning method according to claim 1, wherein each of the third linear equations in the first set of linear equations corresponds to a different cross bar of the storage cabinet; each fourth linear equation in the second set of linear equations corresponds to a different vertical baffle of the storage cabinet.
3. The storage module positioning method according to claim 1, wherein the first linear equation is determined by a first X coefficient, a first Y coefficient, and a first cutoff distance; the second linear equation is determined by a second X coefficient, a second Y coefficient and a second intercept;
determining the first linear equation set according to the first linear equation, the first distance and the set line number, including:
determining each third linear equation according to the first X coefficient, the first Y coefficient, the first intercept and the set line number;
wherein each of the third linear equations is determined by the first X coefficient, the first Y coefficient and a third intercept corresponding to the third linear equation, and the third intercept corresponding to the third linear equation is determined by the following steps:
calculating a square root of a sum of squares of the first X coefficient and the first Y coefficient as a first value;
calculating the number of lines corresponding to the third linear equation minus one to be used as a second value;
dividing the difference between the first distance and the number of the preset lines minus one to obtain a third value;
taking the sum of the product of the first value, the second value and the third value and the first intercept as a third intercept corresponding to the third linear equation;
determining the second set of line equations according to the second line equation, the second distance and the set column number, including:
determining each fourth linear equation according to the second X coefficient, the second Y coefficient, the second intercept and the set column number;
wherein each of the fourth linear equations is determined by the second X coefficient, the second Y coefficient and a fourth intercept of the fourth linear equation, and the fourth intercept corresponding to the fourth linear equation is determined by the following steps:
calculating a square root of a sum of squares of a second X coefficient and the second Y coefficient as a fourth value;
calculating the number of columns corresponding to the fourth linear equation minus one to be used as a fifth value;
dividing the second distance by the difference obtained by subtracting one from the preset column number to obtain a sixth value;
and determining the sum of the product of the fourth value, the fifth value and the sixth value and the second intercept as a fourth intercept corresponding to the fourth linear equation.
4. The storage unit positioning method of claim 1, wherein positioning the storage unit of the storage cabinet according to the intersection of the third line equation and the fourth line equation comprises:
and determining the straight line intersection point of each third straight line equation and all fourth straight line equations, and associating all straight line intersection points to the storage units of the locker.
5. The storage module positioning method according to claim 3, wherein the first X coefficient is determined according to a difference between a Y coordinate of the second positioning point and a Y coordinate of the first positioning point; the first Y coefficient is determined according to the difference between the X coordinate of the first positioning point and the X coordinate of the second positioning point; the second X coefficient is determined according to the difference between the Y coordinate of the third positioning point and the Y coordinate of the first positioning point, and the second Y coefficient is determined according to the difference between the X coordinate of the first positioning point and the X coordinate of the third positioning point.
6. A storage unit positioning system for use in positioning storage units of a storage cabinet comprising a plurality of said storage units, the system comprising:
the system comprises an acquisition unit, a storage unit and a control unit, wherein the acquisition unit is used for acquiring the coordinates of a first positioning point of a locker, the coordinates of a second positioning point of the locker, the coordinates of a third positioning point of the locker and row and column parameters, the first positioning point and the second positioning point are positioned on a first baffle of the locker, the first positioning point and the third positioning point are positioned on a second baffle of the locker, and the first positioning point, the second positioning point and the third positioning point are positioned on the storage surface of the locker;
the first equation determining unit is used for determining a first linear equation according to the coordinates of the first positioning point and the coordinates of the second positioning point;
the second equation determining unit is used for determining a second linear equation according to the coordinate of the first positioning point and the coordinate of the third positioning point;
the first equation set determining unit is used for determining a first equation set according to the first equation, the coordinates of the third positioning point and the row and column parameters, wherein the first equation set comprises a plurality of third equations parallel to the first equation;
the second equation set determining unit is used for determining a second equation set according to the second linear equation, the coordinates of the second positioning point and the row and column parameters; the second linear equation set comprises a plurality of fourth linear equations parallel to the second linear equations;
and the positioning unit is used for positioning the storage unit of the storage cabinet according to the intersection point of the third linear equation and the fourth linear equation.
7. A storage unit positioning device, comprising:
a memory for storing a program;
a processor for loading the program to perform the method of any one of claims 1 to 5.
8. A computer-readable storage medium, in which a program is stored which, when being executed by a processor, carries out the method according to any one of claims 1 to 5.
9. A storage device, comprising:
the storage cabinet comprises a plurality of storage units;
a processor for obtaining an identification of a target storage unit, and querying a location of the target storage unit according to the identification of the target storage unit, wherein the location is determined by the method according to any one of claims 1-5;
and the actuator is used for storing or taking out the object according to the coordinate of the target storage unit according to the control instruction of the processor.
CN202011432611.5A 2020-12-10 2020-12-10 Storage unit positioning method, system and device, storage medium and storage device Active CN112545211B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011432611.5A CN112545211B (en) 2020-12-10 2020-12-10 Storage unit positioning method, system and device, storage medium and storage device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011432611.5A CN112545211B (en) 2020-12-10 2020-12-10 Storage unit positioning method, system and device, storage medium and storage device

Publications (2)

Publication Number Publication Date
CN112545211A CN112545211A (en) 2021-03-26
CN112545211B true CN112545211B (en) 2022-07-26

Family

ID=75060043

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011432611.5A Active CN112545211B (en) 2020-12-10 2020-12-10 Storage unit positioning method, system and device, storage medium and storage device

Country Status (1)

Country Link
CN (1) CN112545211B (en)

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108960946B (en) * 2017-05-19 2022-04-26 北京京东振世信息技术有限公司 Order display method and device
CN110781355A (en) * 2018-07-31 2020-02-11 中兴通讯股份有限公司 Storage information processing method and device, storage cabinet and storage medium
CN110310438B (en) * 2019-06-18 2024-05-07 深圳怡丰机器人科技有限公司 Intelligent access system
CN111003410B (en) * 2019-12-27 2021-03-23 广东利元亨智能装备股份有限公司 Material storing and taking method and device and robot
CN111366078B (en) * 2020-03-30 2021-12-31 深圳创维-Rgb电子有限公司 Robot dispensing positioning method, system, server and storage medium

Also Published As

Publication number Publication date
CN112545211A (en) 2021-03-26

Similar Documents

Publication Publication Date Title
DE102019130043B4 (en) ROBOT SYSTEM WITH ERROR DETECTION AND DYNAMIC PACKING MECHANISM
DE102019130923B4 (en) ROBOT SYSTEM FOR PALLETIZING PALLETS USING REAL-TIME PLACEMENT SIMULATION
US20230150134A1 (en) Robotic system with dynamic pack adjustment mechanism and methods of operating same
DE102019130902B4 (en) A robot system with a dynamic packing mechanism
JP6746820B1 (en) High-speed confirmation method of warehouse storage map, equipment, storage medium and robot
WO2020211565A1 (en) Rapid warehouse configuration method, apparatus, and storage medium
Tipary et al. Generic development methodology for flexible robotic pick-and-place workcells based on Digital Twin
DE102019130635A1 (en) A ROBOT SYSTEM WITH A PACKING MECHANISM
CN111661548B (en) Article sorting method, apparatus, device and storage medium
JPS6132113A (en) Robot control system
CN116588569B (en) Warehouse material warehouse-in and warehouse-out control method and control system thereof
CN112545211B (en) Storage unit positioning method, system and device, storage medium and storage device
CN113657841A (en) Intelligent stacking method and device and storage medium
WO2023116248A1 (en) Material box, material box identification method, device and apparatus, storage system and medium
TW202226094A (en) Method, device, apparatus, medium, program product and system for warehouse management
CN113567964A (en) Laser radar automatic test method, device and system
Chen et al. Shape tolerance in feeding and fixturing
CN114494667B (en) Data processing system and method for adding crash box
CN117141046B (en) Safety monitoring method and system of aluminum foil cutlery box punch forming machine
Chen et al. A Palletizing System for Microchannel Heat Exchangers Based on 3D Visual Guidance
CN116101679A (en) Intelligent warehouse monitoring method and device, electronic equipment and readable storage medium
CN113895908B (en) Method for planning carrying route of stacking robot
CN116902467A (en) Container positioning method, device, equipment and storage medium
Iriondo et al. Dynamic mosaic planning for a robotic bin-packing system based on picked part and target box monitoring
Pounraj 3D autonomous warehouse simulation by sequential function chart using CoDeSys V3. 5

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant