Elevator control method, device, electronic device and storage medium
By obtaining the position sampling points in the intelligent robot elevator area, determining the optimal sampling point position and planning the elevator path, the path planning and safety problems in the intelligent robot elevator ride control are solved, and higher accuracy and Security.
Patent Information
- Application Number
- CN202111288273.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-11-02
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2041-11-02
AI Technical Summary
When an intelligent robot needs to take an elevator to reach all floors of the building, how to accurately plan the path in a narrow elevator car area to ensure safety and accuracy is a challenge.
By obtaining the position sampling points of the equipment in the elevator area, determining the optimal sampling point position and planning the elevator path based on these positions to ensure that the equipment can enter and exit the elevator safely. The method includes randomly obtaining position sampling points in the elevator area, collecting position parameters according to different orientation angles until the stop conditions are met, and filtering the optimal sampling point posture using preset grid maps and equipment safety policies to generate the ladder path .
It improves the accuracy and safety of path planning of elevator ride control for intelligent equipment, reduces the probability of collision between equipment entering and leaving the elevator, and enhances the safety of movement.
Smart Images

Figure CN114035465B_ABST
Abstract
Description
Technical Field
[0001] Embodiments of the present invention relate to the field of automation control technology, and in particular to an elevator control method, device, electronic device and storage medium. Background Art
[0002] With the development of automation technology and intelligent technology, intelligent robots have been widely used in various scenarios of life. For example, in the cleaning industry, simple and repetitive cleaning tasks can be completed by intelligent floor scrubber robots, which can greatly reduce labor costs and improve the intelligence of cleaning work. However, in the application scenarios of intelligent robots, intelligent robots need to pass through multiple floors of a building, and they need to take the elevator to reach each floor of the building. Faced with the above problems, how to control the path planning of the intelligent robot in and out of the elevator in the narrow elevator car area is different from the planning in the open area, and has higher requirements in terms of planning accuracy and safety. Summary of the invention
[0003] The present invention provides an equipment elevator riding control method, device, electronic equipment and storage medium to realize the elevator riding control of intelligent equipment, improve the accuracy of path planning, and enhance the safety of intelligent equipment movement.
[0004] In a first aspect, an embodiment of the present invention provides a method for controlling a device taking an elevator, wherein the method comprises:
[0005] Acquire the position and posture of at least one position sampling point in the elevator area according to the direction of the device entering and exiting the elevator;
[0006] Determine the optimal sampling point posture according to the cost value corresponding to each of the postures;
[0007] Determine an elevator path according to the optimal sampling point position and posture, and take the elevator according to the elevator path.
[0008] Furthermore, the method acquires the position and posture of at least one position sampling point in the elevator area according to the direction of the device entering and exiting the elevator, including:
[0009] Determine a sampling area within the elevator area according to a threshold range parameter along the direction of the elevator entry and exit;
[0010] Randomly acquire at least one position sampling point in the acquisition area;
[0011] Collecting the posture parameters corresponding to each of the position sampling points according to different orientation angles;
[0012] The sampling area is re-determined according to the threshold range parameter to obtain the position sampling points until a stop condition is met.
[0013] Furthermore, the threshold range parameter in the method includes a horizontal unit distance and a vertical unit distance. Accordingly, the step of determining a sampling area in the elevator area according to the threshold range parameter along the direction of entering and exiting the elevator includes:
[0014] Determine a first position point in the elevator area using the longitudinal unit distance along the direction of entering and exiting the elevator;
[0015] The sampling area is a set of position points in the elevator area that are within a horizontal unit distance from the first position point and whose connection line with the first position point is perpendicular to the direction of entering and exiting the elevator.
[0016] Furthermore, in the method, determining a first position point in the elevator area using the longitudinal unit distance along the direction of entering and exiting the elevator includes:
[0017] Determine whether the first location point exists;
[0018] If it exists, select a position point in the elevator area that differs from the optimal sampling point by the longitudinal unit distance along the direction of entering and exiting the elevator as the new first position point;
[0019] If it does not exist, the current position of the device or the door position of the elevator is used as the first position point.
[0020] Furthermore, the stopping conditions in the method include determining that the device enters the elevator according to the posture parameters, determining that the device moves out of the elevator according to the posture parameters, determining that the device cannot enter the elevator according to the posture parameters, and determining that the device cannot move out of the elevator according to the posture parameters.
[0021] Furthermore, the method determines the optimal sampling point posture according to the cost value corresponding to each posture, including:
[0022] Obtaining a preset grid map, wherein each grid in the preset grid map includes at least the cost value;
[0023] Mapping each of the position sampling points to the grid of the preset grid map according to the position coordinates;
[0024] Determine the cost value corresponding to each of the postures according to the mapping;
[0025] The posture of the position sampling point corresponding to the optimal cost value in different sampling areas in the elevator area is used as the optimal sampling point posture.
[0026] Furthermore, the method determines the elevator path according to the optimal sampling point position, including:
[0027] Determine whether the device can safely enter and exit the elevator according to the optimal sampling point position;
[0028] If it is safe, the elevator path is generated by fitting the optimal sampling point position and posture;
[0029] If it is unsafe, the device is controlled to stop entering or exiting the elevator.
[0030] Furthermore, the method determines whether the device can safely enter and exit the elevator according to the optimal sampling point position, including:
[0031] If the distances between the position coordinates corresponding to the optimal sampling point posture and the elevator door position are both less than the shape threshold of the device, it is determined that the device cannot safely enter the elevator;
[0032] If the position coordinates corresponding to the optimal sampling point posture do not reach the preset elevator area, it is determined that the device cannot be safely moved out of the elevator.
[0033] Furthermore, before determining the elevator path according to the optimal sampling point posture, the method further includes:
[0034] The optimal sampling point postures are screened using a preset device safety policy to discretize the distances between the optimal sampling point postures.
[0035] Furthermore, the method uses a preset device security policy to select the optimal sampling point posture, including:
[0036] Determine the distance between two adjacent optimal sampling point postures in sequence according to the positions of the optimal sampling point postures;
[0037] For each of the optimal sampling point postures, if the distance is less than a preset safety threshold, the optimal sampling point posture before the current optimal sampling point posture is eliminated.
[0038] Furthermore, the method presets thresholds including at least an in-elevator safety threshold and an out-elevator safety threshold.
[0039] Furthermore, the method determines the elevator path according to the optimal sampling point position, including:
[0040] At least one line segment is generated by sequentially connecting the positions of the optimal sampling points;
[0041] Path points are determined at equal intervals within each of the line segments, and the connecting lines corresponding to the path points are used as the elevator path.
[0042] In a second aspect, an embodiment of the present invention further provides an elevator control device for equipment, wherein the device comprises:
[0043] A posture sampling module is used to obtain the posture of at least one position sampling point in the elevator area according to the direction of the device entering and exiting the elevator;
[0044] A posture determination module, used to determine the optimal sampling point posture according to the cost value corresponding to each posture;
[0045] A path planning module is used to determine an elevator path according to the optimal sampling point position and take the elevator according to the elevator path.
[0046] In a third aspect, an embodiment of the present invention further provides an electronic device, wherein the electronic device includes:
[0047] one or more processors;
[0048] a memory for storing one or more programs,
[0049] When the one or more programs are executed by the one or more processors, the one or more processors implement the equipment elevator control method as described in any one of the embodiments of the present invention.
[0050] In a fourth aspect, an embodiment of the present invention further provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements an elevator control method for an equipment as described in any one of the embodiments of the present invention.
[0051] The embodiment of the present invention collects the postures of different positions in the elevator area according to the direction of the equipment entering and exiting the elevator, uses the cost value of each posture to determine the optimal sampling point posture, plans the elevator path according to the optimal sampling point posture and controls the equipment to take the elevator, thereby realizing the elevator riding control of intelligent equipment, improving the accuracy of path planning, and enhancing the safety of the movement of intelligent equipment. BRIEF DESCRIPTION OF THE DRAWINGS
[0052] Figure 1 This is a flow chart of a device elevator control method provided in Embodiment 1 of the present invention;
[0053] Figure 2 This is an example diagram of the orientation of an entry and exit ladder provided in the first embodiment of the present invention;
[0054] Figure 3 This is a flow chart of a device elevator control method provided in Embodiment 2 of the present invention;
[0055] Figure 4 This is a flow chart of a device elevator control method provided in Embodiment 3 of the present invention;
[0056] Figure 5 This is an example diagram of forward sampling provided by Embodiment 3 of the present invention;
[0057] Figure 6 This is an example diagram of a ladder entry path provided by Embodiment 3 of the present invention;
[0058] Figure 7 This is an example diagram of a condition determination provided by Embodiment 3 of the present invention;
[0059] Figure 8 is an example diagram of an exit path provided by Embodiment 3 of the present invention;
[0060] Fig. 9 It is a structural schematic diagram of an elevator control device provided by Embodiment 4 of the present invention;
[0061] Fig.10 This is a schematic diagram of the structure of an electronic device provided in Embodiment 5 of the present invention. DETAILED DESCRIPTION
[0062] The present invention will be further described in detail below in conjunction with the accompanying drawings and embodiments. It is to be understood that the specific embodiments described herein are only used to explain the present invention, rather than to limit the present invention. It should also be noted that, for ease of description, only parts related to the present invention are shown in the accompanying drawings, rather than all structures. In addition, the embodiments of the present invention and the features in the embodiments may be combined with each other without conflict.
[0063] Embodiment 1
[0064] Figure 1 is a flow chart of a device elevator control method provided in Embodiment 1 of the present invention. This embodiment can be applied to the case of controlling an intelligent device to automatically take an elevator. The method can be executed by a device elevator control device, which can be implemented in hardware and / or software. Figure 1 The embodiment of the present invention provides a device elevator control method which specifically includes the following steps:
[0065] Step 110: Acquire the position and posture of at least one position sampling point in the elevator area according to the direction of the device entering and exiting the elevator.
[0066] The device may be an intelligent device that enters or moves out of the elevator, and may include a courier robot, a sweeping robot, a food delivery robot, etc. The direction of entering and exiting the elevator may be the direction in which the device enters and exits the elevator, and may be the direction facing the elevator door, for example, see Figure 2, the device is outside the elevator area 1, and the direction of the elevator can be the direction of entering the elevator, specifically the direction of the line connecting the elevator waiting point 3 and the elevator door center 2. Correspondingly, if the device is inside the elevator, the direction of the elevator can be the direction of the device moving out of the elevator, or the current front direction of the device. The elevator area can be the area where the elevator body is located, which can be the two-dimensional ground area of the elevator or the three-dimensional space area of the elevator. The elevator area can be acquired by a visual sensor or a distance sensor. The position sampling point can be one or more position points in the elevator area, and the position sampling point can be located in the elevator area. The posture can be the depth position and posture, where the position can be determined by the three-dimensional space coordinates, and the posture can be determined by the pitch angle, roll angle and heading angle of the robot.
[0067] In an embodiment of the present invention, multiple position sampling points can be obtained in sequence in the elevator area according to the direction of the device entering and exiting the elevator, and the posture of the device when it is safely located at the position point can be obtained at each position sampling point. It can be understood that there is no restriction on the method of obtaining the position sampling points. For example, the elevator area can be divided into multiple sub-areas, and a number of position points in each sub-area are selected as position sampling points. Multiple position sampling points can also be determined in the entire elevator area using a scattered point method.
[0068] Step 120: Determine the optimal sampling point pose according to the cost value corresponding to each pose.
[0069] The cost value may be a parameter value reflecting whether the equipment in the elevator area can travel safely. Different values of the cost value may reflect whether the location point is in an obstacle-existing, obstacle-free, or unknown area. The cost value may be determined by the environment in the elevator area. The optimal sampling point posture may be one or more postures that make the equipment travel the safest among all postures.
[0070] Specifically, the cost value of the elevator area can be obtained, and the cost value can be determined by the device or server according to the real-time environmental information in the elevator. The cost value corresponding to each posture can be determined according to the position of the position sampling point in the elevator area, and one or more postures can be selected as the optimal sampling point posture according to the value of each cost value. The number of optimal sampling point postures can be determined by the elevator specifications and / or equipment specifications.
[0071] It can be understood that step 110 to step 120 may be repeated for multiple times, and one or more optimal sampling points may be acquired by repeating step 110 to step 120 once each time.
[0072] Step 130: determine the elevator path according to the optimal sampling point position, and take the elevator according to the elevator path.
[0073] The elevator path may be a navigation path used for the movement of the device, and the elevator path may be composed of one or more locations.
[0074] In an embodiment of the present invention, the collected optimal sampling point posture can be fitted according to the position, and the straight line or broken line generated by the fitting can be used as the elevator path of the device, and the device can be controlled to enter or exit the elevator according to the elevator path.
[0075] The embodiment of the present invention collects the postures of different positions in the elevator area according to the direction of the equipment entering and exiting the elevator, uses the cost value of each posture to determine the optimal sampling point posture, plans the elevator path according to the optimal sampling point posture and controls the equipment to take the elevator, thereby realizing the elevator riding control of intelligent equipment, improving the accuracy of path planning, and enhancing the safety of the movement of intelligent equipment.
[0076] Embodiment 2
[0077] Figure 3 is a flow chart of a device elevator control method provided by Embodiment 2 of the present invention. The embodiment of the present invention is a specific embodiment based on the above-mentioned embodiment of the invention. Figure 3 The method provided in the embodiment of the present invention specifically includes the following steps:
[0078] Step 210: determine a sampling area in the elevator area according to a threshold range parameter along the direction of entering and exiting the elevator.
[0079] The preset range parameter may be a parameter for partitioning the elevator area, and the preset range parameter corresponding to different elevator area partitioning methods may also be in different forms, and the preset range parameter may be a side length or a perimeter. The sampling area may be an area for obtaining the sampling point of the current position, and the sampling area may be all or part of the elevator area.
[0080] Specifically, the elevator area can be divided into one or more sampling areas using a threshold range parameter along the direction of the elevator. For example, if the threshold range parameter is the area requirement of the sampling area, multiple sampling areas that meet the area requirement can be randomly obtained in the elevator area according to the area requirement. For another example, if the threshold range parameter is a horizontal unit distance and a vertical unit distance, the elevator area within the horizontal unit distance and the vertical unit distance can be selected along the direction of the elevator, and then the elevator area within the horizontal unit distance and the vertical unit distance can be selected again along the direction of the elevator based on the new sampling area. The sampling area is obtained by repeating the above process.
[0081] Step 220: randomly acquire at least one position sampling point in the acquisition area.
[0082] In an embodiment of the present invention, multiple position sampling points can be randomly determined in each acquisition area. The method of determining the multiple position points can be implemented by simulating point scattering. For example, a random number algorithm can be used to generate multiple coordinates within the coordinate range of each acquisition area, and the generated coordinates can be used as position sampling points.
[0083] Step 230: collect the posture parameters corresponding to each position sampling point according to different orientation angles.
[0084] The orientation angle may be the orientation of the front of the device. The posture parameters may include position coordinates and posture parameters of the posture.
[0085] Specifically, the posture of the device can be collected at each position sampling point, and the collection method can include collecting the corresponding position coordinates and posture parameters for different orientation angles. For example, the posture parameters of the device at different orientation angles can be collected in sequence at each position sampling point with a unit angle as a step, where the unit angle T=0.017.
[0086] Step 240: Re-determine the sampling area according to the threshold range parameter to obtain position sampling points until the stop condition is met.
[0087] The stop condition may be a condition for stopping acquiring position sampling points, and the stop condition may include that no position sampling points meeting the requirements can be acquired within the sampling area or the number of acquired position sampling points meets a certain number.
[0088] Specifically, steps 210-230 may be repeatedly executed, and the process of determining the sampling area and acquiring the position sampling points may be repeatedly executed using the threshold range parameter to collect the position sampling points of multiple areas in the elevator area and the postures of the corresponding position sampling points until the collected position sampling points meet the stop condition.
[0089] Step 250: Obtain a preset grid map, wherein each grid in the preset grid map includes at least a cost value.
[0090] Among them, the preset grid map can be a map in the form of a grid. The grid map can be generated according to the environmental information of the elevator area collected by the equipment. The grid map can be composed of multiple grids, and each grid stores at least the cost value of the corresponding position in the elevator area.
[0091] Specifically, when the device is controlled to take the elevator, a pre-generated grid map may be obtained, and the cost value corresponding to each grid in the grid map may be extracted.
[0092] Step 260: Map each position sampling point to a grid of a preset grid map according to the position coordinates.
[0093] In an embodiment of the present invention, a grid having the same position coordinates in a preset grid map can be determined according to the position coordinates for each position sampling point, and a mapping relationship between each position sampling point and the grid can be determined. It can be understood that the mapping relationship can be a one-to-one mapping or a many-to-one mapping. For example, if multiple position sampling points can be mapped to one grid, one position sampling point can also be mapped to one grid.
[0094] Step 270: Determine the cost value corresponding to each pose according to the mapping.
[0095] Specifically, for each sampling point at each position, a cost value stored in a corresponding grid can be obtained in a preset grid map according to the above mapping, and the cost value can be used as a sampling value corresponding to each sampling point at each position.
[0096] Step 280: The posture of the sampling point corresponding to the optimal cost value of different sampling areas in the elevator area is used as the optimal sampling point posture.
[0097] In an embodiment of the present invention, the posture of each position sampling point can be partitioned according to the sampling area in the elevator area, and the cost values of each position sampling point are compared for different partitions, and the cost value that makes the equipment safest is selected as the optimal position sampling point, and the posture of the optimal position sampling point is used as the optimal sampling posture. It can be understood that the number of optimal sampling postures can be multiple, for example, there are multiple position sampling points with the same cost value or multiple postures of the position sampling point with the best cost value in the partition, and the postures of the above position sampling points can all be the optimal sampling point postures.
[0098] Step 290: Determine whether the device can safely enter and exit the elevator based on the optimal sampling point position.
[0099] Specifically, the posture of each sampling point can be detected to determine whether it is safe to control the device to enter and exit the elevator according to the optimal sampling point posture. The safety judgment criteria may include that the device may collide with an obstacle when traveling according to the optimal sampling point posture, or that the device may be stuck by the elevator door when traveling according to the optimal sampling point posture. The way to judge safety may include whether the distance between the position using the optimal sampling point posture and the obstacle is greater than the device's external dimensions or whether the posture of the optimal sampling point posture is the same as or similar to the direction of the device entering and exiting the elevator.
[0100] Step 2100: If it is safe, use the optimal sampling point pose fitting to generate the elevator path; if it is not safe, control the device to stop entering and exiting the elevator.
[0101] In an embodiment of the present invention, after determining that the positions of each optimal sampling point are safe, the positions of the safe optimal sampling point positions can be used to fit and generate an elevator path. If all the optimal sampling point positions are unsafe, the elevator path cannot be generated according to the optimal sampling point positions, and the control device will not stop entering or moving out of the elevator.
[0102] In an embodiment of the present invention, a sampling area is determined in an elevator area according to a threshold range parameter along the direction of entering and exiting the elevator, a position sampling point is obtained in the sampling area, and the posture parameters of each position sampling point at different orientation angles are collected. The above process is repeated until the position sampling point stops, a preset grid map is obtained, and a mapping between the position sampling point and the grid in the grid map is determined. According to the mapping, the cost value of each position sampling point in each grid is determined, and the posture of the position sampling point corresponding to the optimal cost value of different sampling areas in the elevator area is used as the optimal sampling point posture. Each optimal sampling point is judged to determine whether the device can enter and exit the elevator. If it is safe, the optimal sampling point posture is used to fit and generate an elevator path. Otherwise, the device is stopped from entering and exiting the elevator, so as to realize the elevator riding control of the intelligent device, improve the accuracy of path planning, and enhance the safety of the movement of the intelligent device.
[0103] Furthermore, on the basis of the above-mentioned embodiments of the invention, whether the device can safely enter and exit the elevator is determined according to the optimal sampling point posture, including: if the distance between the position coordinates corresponding to the optimal sampling point posture and the elevator door position is less than the device's appearance threshold, it is determined that the device cannot safely enter the elevator; if the position coordinates corresponding to the optimal sampling point posture do not reach the preset elevator area, it is determined that the device cannot safely move out of the elevator.
[0104] Among them, the elevator door position can be a parameter reflecting the location of the elevator, specifically the position coordinates of the center point of the elevator door, the shape threshold can be the length or width of the device, the preset elevator area can be the waiting position of the device for taking the elevator, and the preset elevator area can be determined by the server or the device itself according to the environment in which the elevator is located.
[0105] In an embodiment of the present invention, the method of determining whether the device can safely enter and exit the elevator may include determining the positional relationship between the optimal sampling point posture and the elevator door and the positional relationship with the preset elevator riding area. The position of the optimal sampling point posture may be compared with the elevator door position of the elevator. If the distance between the position and the elevator door position is less than the device's appearance threshold, it is determined that the device is at risk of colliding with the elevator door when it is in the optimal sampling point posture. The optimal sampling point posture may also be compared with the position of the preset elevator riding area of the elevator. If the optimal sampling point postures do not belong to the preset elevator riding area, it indicates that the device cannot safely reach the preset elevator riding area from the elevator, that is, it cannot get off the elevator, and therefore there is a safety risk.
[0106] Embodiment 3
[0107] Figure 4 is a flow chart of a device elevator control method provided by Embodiment 3 of the present invention. The embodiment of the present invention is a specific implementation based on the above invention. Figure 4 The method provided in the embodiment of the present invention specifically includes the following steps:
[0108] Step 310: determine a first position point in the elevator area using a longitudinal unit distance along the direction of entering and exiting the elevator.
[0109] The longitudinal unit distance may be a unit distance that the device moves along the direction of the elevator, and the length of the longitudinal unit distance may be set based on experience. The first position point may be a position point after the device moves along the direction of the elevator, and the distance between the position point and the starting position of the movement may be the longitudinal unit distance.
[0110] In the embodiment of the present invention, the current position may be used as a starting point to move a longitudinal unit distance in the direction of the elevator, and the position after the movement may be recorded as a first position point.
[0111] Step 320: The set of position points in the elevator area that are within the horizontal unit distance from the first position point and whose connection lines with the first position point are perpendicular to the direction of entering and exiting the elevator is taken as the sampling area.
[0112] Among them, the horizontal unit distance can be the unit distance that the device moves in a direction perpendicular to the direction of entering and exiting the elevator. The length of the horizontal unit distance can be set according to experience, and the value of the horizontal unit distance can be the same as or different from the value of the vertical unit distance.
[0113] Specifically, a straight line perpendicular to the direction of entering and exiting the elevator can be determined through the first position point, and the set of position points on the straight line whose distance from the first position point is less than or equal to the horizontal unit distance can be recorded as the sampling area. It can be understood that the sampling area can be composed of one or more position points.
[0114] Step 330: randomly acquire at least one position sampling point in the acquisition area.
[0115] Step 340: collect the posture parameters corresponding to the sampling points at each position according to different orientation angles.
[0116] Step 350: Re-determine the sampling area according to the threshold range parameter to obtain position sampling points until the stop condition is met.
[0117] Further, based on the above-mentioned embodiments of the invention, the stop conditions include determining that the device enters the elevator according to the posture parameters, determining that the device moves out of the elevator according to the posture parameters, determining that the device cannot enter the elevator according to the posture parameters, and determining that the device cannot move out of the elevator according to the posture parameters.
[0118] In an embodiment of the present invention, the stop condition may be a judgment on the posture parameters of the collected position sampling point, which may include a judgment on whether the device has entered the elevator from the outside of the elevator when it is located at the position sampling point with the posture, or whether the device has moved out of the elevator from the inside of the elevator when it is located at the position sampling point with the posture, or whether the device cannot enter the elevator from the outside of the elevator when it is located at the position sampling point with the posture, or whether the device cannot move out of the elevator from the inside of the elevator when it is located at the position sampling point with the posture.
[0119] Step 360: Obtain a preset grid map, wherein each grid in the preset grid map includes at least a cost value.
[0120] Step 370: Map each position sampling point to a grid of a preset grid map according to the position coordinates.
[0121] Step 380: Determine the cost value corresponding to each pose according to the mapping.
[0122] Step 390: The posture of the sampling point corresponding to the optimal cost value in different sampling areas in the elevator area is taken as the optimal sampling point posture.
[0123] Step 3100: Use a preset device security policy to filter the optimal sampling point postures to discretize the distances between the optimal sampling point postures.
[0124] Among them, the preset equipment safety strategy can be a strategy for controlling the safe movement of equipment out of the elevator or the safe entry into the elevator. The preset equipment safety strategy can be generated comprehensively based on the equipment dimensions and the elevator dimensions. The preset equipment safety strategy can be used to screen the optimal sampling point posture, which can improve the dispersion of the optimal sampling point posture, prevent the existence of a large number of turning points in the elevator path, and reduce the risk of the equipment being stuck in the gap of the elevator door during movement.
[0125] In an embodiment of the present invention, the optimal sampling point postures can be screened according to a preset equipment safety strategy, so that the distances between the screened optimal sampling point postures are more discrete, which can improve the smoothness of the elevator path in subsequent processes and improve the safety of equipment movement.
[0126] Step 3110: Determine whether the device can safely enter and exit the elevator based on the optimal sampling point position.
[0127] Step 3120: If it is safe, then connect the optimal sampling points in sequence to generate at least one line segment; determine path points at equal intervals in each line segment, and use the lines corresponding to each path point as the elevator path. If it is not safe, control the device to stop entering and exiting the elevator.
[0128] Among them, the path point can be a position point in the line segment connected by the optimal sampling point posture, and can be a basic element constituting the elevator path. The number of path points can be determined according to user needs and application scenarios. For example, the more complex the elevator environment of the equipment, the more path points can be generated.
[0129] Specifically, when it is determined that each optimal sampling point is safe, the positions of each optimal sampling point can be connected into multiple line segments in sequence according to the position, and one or more path points can be selected in each line segment so that the distances between the path points are equal, and the path points can be connected in sequence as the elevator path. When it is determined that each optimal sampling point is unsafe, the device may not be controlled to enter and exit the elevator, and the current state of the device may be maintained, for example, continue to wait for the next elevator or continue to wait for the opportunity to get off the elevator again.
[0130] In an embodiment of the present invention, a first position point in an elevator area of a longitudinal unit distance is determined along the direction of entering and exiting an elevator, and a position point within a transverse unit distance in a direction perpendicular to the direction of entering and exiting the elevator is used as a sampling area, and a position sampling point is determined in the sampling area, and posture parameters of different orientation angles on each position sampling point are obtained, and a new sampling area is regenerated and position sampling points are collected until the newly collected position sampling points meet a stop condition, and a cost value of each position sampling point in a preset grid map is obtained, and the posture of the position sampling point corresponding to the optimal cost value of different sampling areas is used as the optimal sampling point posture, and the optimal sampling point posture is screened according to a preset device safety strategy to discretize the distance between the optimal sampling point postures, and after determining that the device can safely perform the elevator according to the optimal sampling point posture, multiple line segments are connected using the optimal sampling point posture, and path points are determined at equal distances in the line segments, and the path points are connected as an elevator path and the elevator is taken, otherwise, the device is controlled to stop entering and exiting the elevator, thereby realizing the intelligent degree of the device taking the elevator, improving the accuracy of path planning, reducing the collision probability of the device entering and exiting the elevator, and improving the safety of the device moving by elevator.
[0131] Further, based on the above-mentioned embodiment of the invention, the first position point is determined in the elevator area using a longitudinal unit distance along the direction of entering and exiting the elevator, including:
[0132] Determine whether there is a first position point; if so, select a position point in the elevator area along the direction of entering and exiting the elevator that is a unit longitudinal distance away from the position sampling point as the new first position point; if not, use the current position of the device or the elevator door position as the first position point.
[0133] In the embodiment of the present invention, when the first position point is determined by longitudinal movement, it can be determined whether the first position point already exists. If it does, the longitudinal unit distance is continued to be moved along the direction of entering and exiting the elevator based on the optimal sampling point posture, and the position point at the corresponding position can be used as the new first position point. If it does not exist, the current position of the device is used as the first position point when the device moves out of the elevator, or the elevator door position is used as the first position point when the device enters the elevator.
[0134] Further, based on the above-mentioned embodiment of the invention, the method of using a preset device security policy to select the optimal sampling point posture includes:
[0135] According to the position of each optimal sampling point posture, the distance between two adjacent optimal sampling point postures is determined in turn; for each optimal sampling point posture, if the distance is less than a preset safety threshold, the optimal sampling point posture before the current optimal sampling point posture is eliminated.
[0136] The preset safety threshold may be data for controlling the degree of discreteness of the optimal sampling point. Reasonable setting of the preset safety threshold may improve the smoothness of the elevator path and reduce the occurrence of inflection points in the elevator path to avoid collisions during the movement of the equipment. The current optimal sampling point posture may be a posture that is far away from the starting point of the equipment.
[0137] In an embodiment of the present invention, any adjacent optimal sampling point postures can be screened. If the distance between two optimal sampling points is less than a preset safety threshold, the optimal sampling point posture close to the device trigger position is deleted. The above process can be repeatedly performed so that the distance between each optimal sampling point posture is greater than the preset safety threshold, thereby increasing the discreteness between the optimal sampling point postures.
[0138] Further, based on the above-mentioned embodiments of the invention, the preset safety thresholds include at least an in-elevator safety threshold and an out-elevator safety threshold.
[0139] Specifically, the preset safety threshold can adopt different distance thresholds inside and outside the elevator. When the current optimal sampling point position is inside the elevator, the safety threshold inside the elevator can be used to screen each optimal sampling point. When the current optimal sampling point position is outside the elevator, the safety threshold outside the elevator can be used to screen each optimal sampling point. It can be understood that due to the complex environment inside the elevator, the safety threshold inside the elevator is generally smaller than the safety threshold outside the elevator. For example, the safety threshold inside the elevator is 0.5, and the safety threshold outside the elevator is 1.5. The safety threshold inside the elevator and the safety threshold outside the elevator can be set based on the appearance of the equipment and the environment in which the equipment is located. In one case, the environmental parameters collected by the equipment can be used to dynamically adjust the values of the safety threshold inside the elevator and the safety threshold outside the elevator.
[0140] In an exemplary embodiment, taking a sweeping robot as an example, the control strategy of the sweeping robot entering and exiting an elevator can be subdivided into elevator entry control and elevator exit control, wherein the elevator entry control may include the following steps:
[0141] Step 1) After the sweeping robot has finished cleaning a certain task on a certain floor and needs to perform a cleaning task on another floor, the sweeping robot can navigate to the elevator waiting area in front of the elevator, which can be configured by the user or manufacturer according to parameters. The sweeping robot can send a signal to arrive at the elevator waiting area and wait for the elevator entry instruction. The elevator entry instruction can be generated by the sweeping robot itself or by the control server. After the robot receives the elevator entry instruction, the robot can be controlled to navigate to the elevator entry point. The elevator entry point can be determined by the elevator area and the elevator entry depth. For example, it can be based on the elevator waiting area extending straight forward toward the elevator area ld = 2 + inside_distance, where the inside distance can be the elevator entry depth, thereby determining the intersection of the elevator area, and the intersection can be used as the elevator entry point.
[0142] 2) Obtain a set of optimal entry sampling points through forward sampling. Figure 5 The specific process is to sample (scatter points) based on the unit longitudinal length lo = 0.075 (the direction of the robot's front and back connection) and the horizontal length la = 0.025 (the direction of the robot's left and right connection). The unit longitudinal length can be Figure 5 The length of the arrow shown, the horizontal length can be Figure 5 The distance between adjacent arrows on the same layer is shown. Among them, forward sampling includes: the initial sampling point is the current position pc of the robot, based on the orientation of pc, it advances forward by a unit longitudinal length lo, and then performs sampling in the horizontal direction. Each forward advance of a unit lo and the horizontal sampling of the point and the angle sampling mentioned later are considered to be a forward sampling process. The number of horizontal sampling nl in each forward sampling process is obtained by the formula:
[0143] nl=max{[10*e(-2.0*n*lo)],2}, where n can be 1, which is the number of horizontal upsampling times.
[0144] Based on the determined nl and la, a set of coordinate points under the longitudinal length can be obtained by sampling in the vertical direction (horizontally) of the robot, and then each coordinate point is sampled in the left and right directions at a unit angle T = 0.017 (radians) to obtain the posture of the robot under different directions at the sampling point. The number of angle samplings in each forward sampling process is recorded as na. Similarly, the number of angle samplings for each coordinate point is calculated by another convergence function with the number of forward samplings as the independent variable. The formula is as follows:
[0145] na=max{[10*e(-4.0*n*lo)],2}.
[0146] 3) After a forward sampling is completed, the safest posture is selected for all poses sampled this time based on the cost map, and placed in the sampling optimal point container Ve. At the same time, the distance between the safest point and the elevator door point Pdoor is calculated, recorded as Dbd. Once this safest point is within the elevator area and Dbd is greater than or equal to inside_distance. The entire sampling is considered completed and forward sampling is no longer continued. Otherwise, the unit longitudinal length is extended longitudinally based on this optimal point, and then the next forward sampling is performed, and the next optimal point is calculated and stored in Ve for reciprocating. At the same time, during the entire forward sampling period, if a forward sampling cannot find any safe point, the entire forward sampling process is considered to have failed, and it is considered that there is no safe path to enter the elevator.
[0147] 4) Arrive at the entry point and start forward sampling to obtain a set of optimal sampling points, then fit the line segment and find the true center entry point. Based on this point and the unit sampling angle, perform straight line path sampling to obtain a centered and safe path. Figure 6 Path 1 above the sampling point is the final generated path. The control part is implemented by fitting to this path to enter the center of the ladder.
[0148] Accordingly, the elevator exit control may include the following steps:
[0149] 1) When the vehicle body faces the elevator door, wait for the elevator exit signal. Once the elevator exit signal is received, the forward sampling is performed in the same way as the elevator entry. The forward sampling process is not described here. The difference from the elevator entry is the termination condition for the completion of the forward sampling of the elevator exit: when the sampling point exceeds the preset elevator entry point (and is farther away from the elevator relative to the elevator entry point), the sampling can be successfully exited. Once any of the following two conditions are met, the sampling will be exited: the next forward sampling fails and cannot be found at an optimal point; the optimal point obtained by this forward sampling enters the elevator waiting area (retain this point).
[0150] 2) Here, the optimal point set obtained by forward sampling is stored in a container Vo, and the first two points are taken out of Vo (the first point is the current position of the robot) and put into another empty container Vt for storing discrete ladder path points. Enter a loop, take out the front point pg from Vo, and connect the second to last point ps in Vt with pg, and the length of the connection is dsg. A set of conditions are used to determine different operations on Vt: ① Update the data of the last point in Vt to the data of this pg point; ② Put this pg point into the tail of Vt. The end of the loop flag is used to see whether Vo has been taken. The judgment is based on the conditions such as Figure 7. If the point currently taken from Vo is inside the elevator, the longest straight line segment of the path inside the elevator is limited to 0.5 meters after the points are connected. If it is outside the elevator, the longest straight line segment is limited to 1.5 meters. This is to prevent the points from being connected at the elevator door. The appearance of the inflection point will cause the robot's wheels to get stuck near the gap of the elevator door. After a loop calculation, a group of scattered points are obtained and stored in Vt. Next, this group of points is connected one by one, and the path points of this group of connected line segments are filled to form a path for exiting the elevator composed of equally spaced discrete points. The effect of the exit path generation is as follows: Figure 8 , dotted line 3 is the direction of the sweeping robot exiting the ladder, and the generated line segment 2 is the exiting ladder path.
[0151] Embodiment 4
[0152] Fig. 9 401, a posture sampling module 402, a posture determination module 402, and a path planning module 403.
[0153] The posture sampling module 401 is used to obtain the posture of at least one position sampling point in the elevator area according to the direction of the device entering and exiting the elevator.
[0154] The posture determination module 402 is used to determine the optimal sampling point posture according to the cost value corresponding to each posture.
[0155] The path planning module 403 is used to determine the elevator path according to the optimal sampling point position and take the elevator according to the elevator path.
[0156] In the embodiment of the present invention, a posture sampling module collects the postures of different positions in the elevator area according to the direction of the equipment entering and exiting the elevator. The posture determination module uses the cost value of each posture to determine the optimal sampling point posture. The path planning module plans the elevator path according to the optimal sampling point posture and controls the equipment to take the elevator, thereby realizing the elevator riding control of intelligent equipment, improving the accuracy of path planning, and enhancing the safety of the movement of intelligent equipment.
[0157] Further, based on the above-mentioned embodiment of the invention, the posture sampling module 401 includes:
[0158] The area determination unit is used to determine a sampling area in the elevator area according to a threshold range parameter along the direction of entering and exiting the elevator.
[0159] A sampling point unit, used to randomly acquire at least one position sampling point in the acquisition area;
[0160] The position parameter unit is used to collect the position parameters corresponding to each of the position sampling points according to different orientation angles.
[0161] A stop determination unit is used to redetermine the sampling area according to the threshold range parameter to obtain the position sampling point until a stop condition is met.
[0162] Further, based on the above-mentioned embodiment of the invention, the region determination unit 402 includes:
[0163] The longitudinal movement subunit is used to determine a first position point in the elevator area using the longitudinal unit distance along the direction of entering and exiting the elevator.
[0164] The transverse subunit is used to take the set of position points in the elevator area that are within a transverse unit distance from the first position point and whose connection line with the first position point is perpendicular to the direction of entering and exiting the elevator as the sampling area.
[0165] Furthermore, based on the above-mentioned embodiments of the invention, the longitudinal movement subunit is specifically used to: determine whether the first position point exists; if so, select a position point in the elevator area along the direction of entering and exiting the elevator that differs from the optimal sampling point posture by the longitudinal unit distance as a new first position point; if not, use the current position of the device or the elevator door position of the elevator as the first position point.
[0166] Furthermore, based on the above-mentioned embodiments of the invention, the stop conditions in the device include determining that the device enters the elevator according to the posture parameters, determining that the device moves out of the elevator according to the posture parameters, determining that the device cannot enter the elevator according to the posture parameters, and determining that the device cannot move out of the elevator according to the posture parameters.
[0167] Further, based on the above-mentioned embodiment of the invention, the posture determination module 402 includes:
[0168] The map acquisition unit is used to acquire a preset grid map, wherein each grid in the preset grid map at least includes the cost value.
[0169] A grid mapping unit is used to map each of the position sampling points to the grid of the preset grid map according to the position coordinates.
[0170] A cost value unit is used to determine the cost value corresponding to each of the postures according to the mapping.
[0171] The optimal determination unit is used to use the posture of the position sampling point corresponding to the optimal cost value of different sampling areas in the elevator area as the optimal sampling point posture.
[0172] Further, based on the above-mentioned embodiment of the invention, the path planning module 403 includes:
[0173] A safety judgment unit is used to determine whether the device can safely enter and exit the elevator according to the optimal sampling point posture.
[0174] A path planning execution unit is used to use the optimal sampling point posture fitting to generate the elevator path if it is safe; if it is not safe, control the device to stop entering and exiting the elevator.
[0175] Furthermore, based on the above-mentioned embodiments of the invention, the safety judgment unit is specifically used for: if the distance between the position coordinates corresponding to the optimal sampling point posture and the elevator door position is less than the appearance threshold of the device, it is determined that the device cannot safely enter the elevator; if the position coordinates corresponding to the optimal sampling point posture do not reach the preset elevator area, it is determined that the device cannot safely move out of the elevator.
[0176] Furthermore, based on the above-mentioned embodiment of the invention, the apparatus further includes: a posture discretization module, which is used to use a preset device safety policy to filter the optimal sampling point postures to discretize the distances between the optimal sampling point postures.
[0177] Further, based on the above-mentioned embodiment of the invention, the posture discretization module includes:
[0178] The distance determination unit is used to determine the distance between two adjacent optimal sampling point postures in sequence according to the positions of the optimal sampling point postures.
[0179] The posture screening unit is used to eliminate the optimal sampling point posture before the current optimal sampling point posture if the distance is less than a preset safety threshold for each optimal sampling point posture.
[0180] Further, based on the above-mentioned embodiments of the invention, the preset safety thresholds include at least an in-elevator safety threshold and an out-elevator safety threshold.
[0181] Furthermore, based on the above-mentioned embodiments of the invention, the path planning execution unit is specifically used to: connect in sequence according to the positions of each of the optimal sampling points to generate at least one line segment; determine path points at equal intervals within each of the line segments, and use the connecting lines corresponding to each of the path points as the elevator path.
[0182] Embodiment 5
[0183] Fig.10 This is a schematic diagram of the structure of an electronic device provided in Embodiment 5 of the present invention. Fig.10 A block diagram of an electronic device 312 suitable for implementing embodiments of the present invention is shown. Fig.10The electronic device 312 shown is only an example and should not limit the functions and scope of use of the embodiments of the present invention. The device 312 is a typical computing device for implementing the device elevator control method.
[0184] like Fig.10 As shown, the electronic device 312 is in the form of a general purpose computing device. The components of the electronic device 312 may include, but are not limited to: one or more processors 316, a storage device 328, and a bus 318 connecting different system components (including the storage device 328 and the processor 316).
[0185] Bus 318 represents one or more of several types of bus structures, including a memory bus or memory controller, a peripheral bus, an accelerated graphics port, a processor or a local bus using any of a variety of bus architectures. For example, these architectures include but are not limited to Industry Standard Architecture (ISA) bus, Micro Channel Architecture (MCA) bus, Enhanced ISA bus, Video Electronics Standards Association (VESA) local bus and Peripheral Component Interconnect (PCI) bus.
[0186] The electronic device 312 typically includes a variety of computer system readable media. These media can be any available media that can be accessed by the electronic device 312, including volatile and non-volatile media, removable and non-removable media.
[0187] The storage device 328 may include computer system readable media in the form of volatile memory, such as random access memory (RAM) 330 and / or cache memory 332. The electronic device 312 may further include other removable / non-removable, volatile / non-volatile computer system storage media. By way of example only, the storage system 334 may be used to read and write non-removable, non-volatile magnetic media ( Fig.10 not shown, usually called a "hard drive"). Although Fig.10Not shown in the figure, a disk drive for reading and writing a removable non-volatile disk (e.g., a "floppy disk"), and an optical disk drive for reading and writing a removable non-volatile optical disk (e.g., a read-only optical disk (Compact Disc-Read Only Memory, CD-ROM), a digital video disk (Digital Video Disc-Read Only Memory, DVD-ROM) or other optical media) may be provided. In these cases, each drive may be connected to the bus 318 via one or more data medium interfaces. The storage device 328 may include at least one program product having a set (e.g., at least one) of program modules that are configured to perform the functions of the various embodiments of the present invention.
[0188] A program 336 having a set (at least one) of program modules 326 may be stored, for example, in a storage device 328, such program modules 326 including, but not limited to, an operating system, one or more application programs, other program modules, and program data, each of which or some combination may include an implementation of a network environment. The program modules 326 generally perform the functions and / or methods of the embodiments described herein.
[0189] The electronic device 312 may also communicate with one or more external devices 314 (e.g., keyboard, pointing device, camera, display 324, etc.), may also communicate with one or more devices that enable a user to interact with the electronic device 312, and / or communicate with any device that enables the electronic device 312 to communicate with one or more other computing devices (e.g., network card, modem, etc.). Such communication may be performed through an input / output (I / O) interface 322. In addition, the electronic device 312 may also communicate with one or more networks (e.g., a local area network (LAN), a wide area network (WAN) and / or a public network, such as the Internet) through a network adapter 320. As shown, the network adapter 320 communicates with other modules of the electronic device 312 through a bus 318. It should be understood that, although not shown in the figure, other hardware and / or software modules may be used in conjunction with the electronic device 312, including but not limited to: microcode, device drivers, redundant processing units, external disk drive arrays, disk arrays (Redundant Arrays of Independent Disks, RAID) systems, tape drives, and data backup storage systems.
[0190] The processor 316 executes various functional applications and data processing by running the programs stored in the storage device 328, such as implementing the equipment elevator control method provided in the above embodiment of the present invention.
[0191] Embodiment 6
[0192] The embodiment of the present invention provides a computer-readable storage medium, on which a computer program is stored, and when the program is executed by a processing device, a device elevator control method as in the embodiment of the present invention is implemented. The above-mentioned computer-readable medium of the present invention may be a computer-readable signal medium or a computer-readable storage medium or any combination of the above two. The computer-readable storage medium may be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples of computer-readable storage media may include, but are not limited to: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In the present disclosure, a computer-readable storage medium may be any tangible medium containing or storing a program, which may be used by an instruction execution system, device or device or used in combination with it. In the present disclosure, a computer-readable signal medium may include a data signal propagated in a baseband or as part of a carrier wave, in which a computer-readable program code is carried. Such propagated data signals may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. Computer readable signal media may also be any computer readable medium other than computer readable storage media, which may send, propagate, or transmit programs for use by or in conjunction with an instruction execution system, apparatus, or device. The program code contained on the computer readable medium may be transmitted using any suitable medium, including but not limited to: wires, optical cables, RF (radio frequency), etc., or any suitable combination of the above.
[0193] In some embodiments, the client and the server may communicate using any currently known or future developed network protocol such as HTTP (HyperText Transfer Protocol), and may be interconnected with any form or medium of digital data communication (e.g., a communication network). Examples of communication networks include a local area network ("LAN"), a wide area network ("WAN"), an internet (e.g., the Internet), and a peer-to-peer network (e.g., an ad hoc peer-to-peer network), as well as any currently known or future developed network.
[0194] The computer-readable medium may be included in the electronic device, or may exist independently without being incorporated into the electronic device.
[0195] The above-mentioned computer-readable medium carries one or more programs. When the above-mentioned one or more programs are executed by the electronic device, the electronic device: obtains the posture of at least one position sampling point in the elevator area according to the direction of the device entering and exiting the elevator; determines the optimal sampling point posture according to the cost value corresponding to each of the postures; determines the elevator path according to the optimal sampling point posture, and takes the elevator according to the elevator path.
[0196] Computer program code for performing the operations of the present disclosure may be written in one or more programming languages or a combination thereof, including, but not limited to, object-oriented programming languages, such as Java, Smalltalk, C++, and conventional procedural programming languages, such as "C" or similar programming languages. The program code may be executed entirely on the user's computer, partially on the user's computer, as a separate software package, partially on the user's computer and partially on a remote computer, or entirely on a remote computer or server. In cases involving a remote computer, the remote computer may be connected to the user's computer through any type of network, including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computer (e.g., through the Internet using an Internet service provider).
[0197] The flow chart and block diagram in the accompanying drawings illustrate the possible architecture, function and operation of the system, method and computer program product according to various embodiments of the present disclosure. In this regard, each square box in the flow chart or block diagram can represent a module, a program segment or a part of a code, and the module, the program segment or a part of the code contains one or more executable instructions for realizing the specified logical function. It should also be noted that in some implementations as replacements, the functions marked in the square box can also occur in a sequence different from that marked in the accompanying drawings. For example, two square boxes represented in succession can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each square box in the block diagram and / or flow chart, and the combination of the square boxes in the block diagram and / or flow chart can be implemented with a dedicated hardware-based system that performs a specified function or operation, or can be implemented with a combination of dedicated hardware and computer instructions.
[0198] The units involved in the embodiments described in the present disclosure may be implemented by software or hardware, wherein the name of a unit does not, in some cases, limit the unit itself.
[0199] The functions described above herein may be performed at least in part by one or more hardware logic components. For example, without limitation, exemplary types of hardware logic components that may be used include: field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), systems on chips (SOCs), complex programmable logic devices (CPLDs), and the like.
[0200] In the context of the present invention embodiment, a machine-readable medium may be a tangible medium that may contain or store a program for use by or in conjunction with an instruction execution system, device, or equipment. A machine-readable medium may be a machine-readable signal medium or a machine-readable storage medium. A machine-readable medium may include, but is not limited to, an electronic, magnetic, optical, electromagnetic, infrared, or semiconductor system, device, or equipment, or any suitable combination of the foregoing. A more specific example of a machine-readable storage medium may include an electrical connection based on one or more lines, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
[0201] Note that the above are only preferred embodiments of the present invention and the technical principles used. Those skilled in the art will understand that the present invention is not limited to the specific embodiments described herein, and that various obvious changes, readjustments and substitutions can be made by those skilled in the art without departing from the scope of protection of the present invention. Therefore, although the present invention has been described in more detail through the above embodiments, the present invention is not limited to the above embodiments, and may include more other equivalent embodiments without departing from the concept of the present invention, and the scope of the present invention is determined by the scope of the appended claims.
Claims
1. A method for controlling elevator riding, characterized in that: The method comprises: Acquire the position and posture of at least one position sampling point in the elevator area according to the direction of the device entering and exiting the elevator; Determine the optimal sampling point posture according to the cost value corresponding to each of the postures; Determine an elevator path according to the optimal sampling point position and take the elevator according to the elevator path; Wherein, acquiring the position and posture of at least one position sampling point in the elevator area according to the direction of entering and exiting the elevator of the equipment includes: Determine a sampling area within the elevator area according to a threshold range parameter along the direction of the elevator entry and exit; Randomly acquire at least one position sampling point in the sampling area; Collecting the posture parameters corresponding to each of the position sampling points according to different orientation angles; The sampling area is re-determined according to the threshold range parameter to obtain the position sampling points until a stop condition is met.
2. The method according to claim 1, characterized in that: The threshold range parameter includes a horizontal unit distance and a vertical unit distance. Accordingly, the sampling area is determined in the elevator area according to the threshold range parameter along the direction of entering and exiting the elevator, including: Determine a first position point in the elevator area using the longitudinal unit distance along the direction of the elevator in and out; The sampling area is a set of position points in the elevator area that are within a horizontal unit distance from the first position point and whose connecting line with the first position point is perpendicular to the direction of the elevator entering and exiting.
3. The method according to claim 2, characterized in that: The step of determining a first position point in the elevator area using the longitudinal unit distance along the direction of the elevator in and out includes: Determine whether the first location point exists; If it exists, select a position point in the elevator area that differs from the optimal sampling point by the longitudinal unit distance along the direction of entering and exiting the elevator as the new first position point; If it does not exist, the current position of the device or the door position of the elevator is used as the first position point.
4. The method according to claim 1, characterized in that: The stop conditions include determining that the device enters the elevator according to the posture parameters, determining that the device moves out of the elevator according to the posture parameters, determining that the device cannot enter the elevator according to the posture parameters, and determining that the device cannot move out of the elevator according to the posture parameters.
5. The method according to claim 1, characterized in that: The step of determining the optimal sampling point posture according to the cost value corresponding to each posture comprises: Obtaining a preset grid map, wherein each grid in the preset grid map includes at least the cost value; Mapping each of the position sampling points to the grid of the preset grid map according to the position coordinates; Determine the cost value corresponding to each of the postures according to the mapping; The posture of the position sampling point corresponding to the optimal cost value in different sampling areas in the elevator area is used as the optimal sampling point posture.
6. The method according to claim 1, characterized in that: The step of determining the elevator path according to the optimal sampling point position and posture comprises: Determine whether the device can safely enter and exit the elevator according to the optimal sampling point position; If it is safe, the elevator path is generated by fitting the optimal sampling point position and posture; If it is unsafe, the device is controlled to stop entering or exiting the elevator.
7. The method according to claim 1, characterized in that: Determining whether the device can safely enter and exit the elevator according to the optimal sampling point posture includes: If the distances between the position coordinates corresponding to the optimal sampling point posture and the elevator door position are both less than the shape threshold of the device, it is determined that the device cannot safely enter the elevator; If the position coordinates corresponding to the optimal sampling point posture do not reach the preset elevator area, it is determined that the device cannot be safely moved out of the elevator.
8. The method according to claim 1, characterized in that: Before determining the elevator path according to the optimal sampling point position, the method further includes: The optimal sampling point postures are screened using a preset device safety policy to discretize the distances between the optimal sampling point postures.
9. The method according to claim 8, characterized in that: The using a preset device security policy to select the optimal sampling point posture includes: Determine the distance between two adjacent optimal sampling point postures in sequence according to the positions of the optimal sampling point postures; For each of the optimal sampling point postures, if the distance is less than a preset safety threshold, the optimal sampling point posture before the current optimal sampling point posture is eliminated.
10. The method according to claim 9, characterized in that: The preset safety threshold includes at least an in-elevator safety threshold and an out-elevator safety threshold.
11. The method according to claim 6, characterized in that: The step of using the optimal sampling point pose fitting to generate the elevator path comprises: At least one line segment is generated by sequentially connecting the positions of the optimal sampling points; Path points are determined at equal intervals within each of the line segments, and the connecting lines corresponding to the path points are used as the elevator path.
12. An equipment elevator control device, characterized in that: The device comprises: A posture sampling module is used to obtain the posture of at least one position sampling point in the elevator area according to the direction of the device entering and exiting the elevator; A posture determination module, used to determine the optimal sampling point posture according to the cost value corresponding to each posture; A path planning module, used to determine an elevator path according to the optimal sampling point position and posture, and take the elevator according to the elevator path; Wherein, the posture sampling module includes: An area determination unit, configured to determine a sampling area within the elevator area according to a threshold range parameter along the direction of the elevator entry and exit; A sampling point unit, used to randomly obtain at least one position sampling point in the sampling area; A position parameter unit, used for collecting the position parameters corresponding to each of the position sampling points according to different orientation angles; A stop determination unit is used to redetermine the sampling area according to the threshold range parameter to obtain the position sampling point until a stop condition is met.
13. An electronic device, characterized in that: The electronic device comprises: one or more processors; a memory for storing one or more programs, When the one or more programs are executed by the one or more processors, the one or more processors implement the equipment elevator control method as described in any one of claims 1-11.
14. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the device elevator control method as described in any one of claims 1-11 is implemented.
Citation Information
Patent Citations
Method for controlling robot to move across floors
CN108002154A
Method and device for acquiring obstacle avoidance path by grid map
CN108241370A
Method for allowing robot to go in and out of elevator and robot control system for going in and out of elevator
CN110788864A
Robot control method, robot and readable storage medium
CN110861095A
Robot path planning method, robot, electronic equipment and storage medium
CN111290385A
