WO2022068926A1 - 用于多机器人混行的方法、装置及存储介质 - Google Patents

用于多机器人混行的方法、装置及存储介质 Download PDF

Info

Publication number
WO2022068926A1
WO2022068926A1 PCT/CN2021/122158 CN2021122158W WO2022068926A1 WO 2022068926 A1 WO2022068926 A1 WO 2022068926A1 CN 2021122158 W CN2021122158 W CN 2021122158W WO 2022068926 A1 WO2022068926 A1 WO 2022068926A1
Authority
WO
WIPO (PCT)
Prior art keywords
point
coordinate system
coordinate
slave
base
Prior art date
Application number
PCT/CN2021/122158
Other languages
English (en)
French (fr)
Inventor
桑云
贾永华
吴永海
李必勇
白寒
Original Assignee
杭州海康机器人技术有限公司
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 杭州海康机器人技术有限公司 filed Critical 杭州海康机器人技术有限公司
Publication of WO2022068926A1 publication Critical patent/WO2022068926A1/zh

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0287Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
    • G05D1/0291Fleet control

Definitions

  • the present application relates to the field of robotics, and in particular, to a method, device and storage medium for multi-robot mixed operation.
  • robots are more and more widely used in logistics, warehousing and factory production.
  • the method of coordinate unification in the related art is to align two coordinate systems by means of rotation and translation.
  • most of the coordinate systems in practical applications are non-linear coordinate systems, it is impossible to accurately achieve the coordinate unity between different types of robots only through rotation and translation, which leads to collisions when different types of robots are mixed in the same workplace. , causing a safety hazard.
  • the purpose of the present application is to provide a method, device and storage medium for multi-robot mixed operation, so as to improve the safety of mixed operation of different types of robots in the same workplace.
  • an embodiment of the present application provides a method for multi-robot mixed driving, which is applied to a scheduling platform.
  • the method includes: determining first travel path information of a robot in a base coordinate system; determining autonomous positioning of the robot
  • the second travel path information is sent to the robot, so that the robot travels according to the second travel path information.
  • an embodiment of the present application provides a method for multi-robot mixed driving, which is applied to a robot.
  • the method includes: receiving third travel path information of the robot in a base coordinate system sent by a scheduling platform; determining The first position information of the robot in the slave coordinate system currently used by the robot for autonomous positioning; using the pre-configured set of riveting point pairs between the slave coordinate system and the base coordinate system, determine the corresponding first position information.
  • an embodiment of the present application provides an apparatus for multi-robot mixed operation, which is applied to a scheduling platform.
  • the apparatus includes: a processor and a non-transitory computer-readable storage medium connected to the processor through a bus ; the non-transitory computer-readable storage medium stores one or more computer programs executable by the processor; the processor implements the following steps when executing the one or more computer programs: determining that the robot is in a basic The first travel path information in the coordinate system; determine the slave coordinate system used for autonomous positioning of the robot; use the set of riveting point pairs between the preconfigured base coordinate system and the slave coordinate system to determine the corresponding first travel path information the second travel path information in the slave coordinate system; sending the second travel path information to the robot, so that the robot travels according to the second travel path information.
  • an embodiment of the present application provides a device for multi-robot mixed operation, which is applied to a robot, and the device includes: a processor and a non-transitory computer-readable storage medium connected to the processor through a bus;
  • the non-transitory computer-readable storage medium stores one or more computer programs executable by the processor; when the processor executes the one or more computer programs, the following steps are implemented: receiving the data sent by the scheduling platform.
  • the third travel path information of the robot in the base coordinate system determine the first position information of the robot in the slave coordinate system currently used by the robot for autonomous positioning; use the preconfigured slave coordinate system and base coordinate
  • a set of riveting point pairs between systems is used to determine the second position information in the base coordinate system corresponding to the first position information; autonomous driving is performed according to the third travel path information and the second position information.
  • an embodiment of the present application provides a device for multi-robot mixed movement, which is applied to a scheduling platform.
  • the device includes: a first determination unit, configured to determine first travel path information of a robot in a base coordinate system
  • the second determination unit is used to determine the slave coordinate system used for autonomous positioning of the robot;
  • the third determination unit is used to use the pre-configured base coordinate system and the set of riveting point pairs between the slave coordinate system to determine the first
  • a travel path information corresponds to second travel path information in the secondary coordinate system;
  • a sending unit is configured to send the second travel path information to the robot, so that the robot travels according to the second travel path information.
  • an embodiment of the present application provides a device for multi-robot mixed operation, which is applied to a robot.
  • the device includes: a receiving unit for receiving the third robot in the base coordinate system sent by the scheduling platform. travel path information; a fourth determination unit for determining the first position information of the robot in the slave coordinate system currently used by the robot for autonomous positioning; and a fifth determination unit for using the preconfigured slave coordinate system
  • the set of riveting point pairs with the base coordinate system determines the second position information in the base coordinate system corresponding to the first position information; the driving unit is used for autonomous driving according to the third travel path information and the second position information.
  • an embodiment of the present application provides a non-transitory computer-readable storage medium, where the non-transitory computer-readable storage medium stores instructions that, when executed by a processor, cause the processor to execute the above-mentioned first Aspects provide steps in a method for multi-robot mixing.
  • an embodiment of the present application provides a non-transitory computer-readable storage medium, where the non-transitory computer-readable storage medium stores instructions that, when executed by a processor, cause the processor to execute the above-mentioned second Aspects provide steps in a method for multi-robot mixing.
  • an embodiment of the present application provides a computer program, which, when executed by a processor, causes the processor to execute the steps in the method for multi-robot mixed operation provided in the first aspect.
  • an embodiment of the present application provides a computer program, which, when executed by a processor, causes the processor to execute the steps in the method for multi-robot mixed operation provided in the second aspect.
  • the first is that the scheduling platform determines the second travel path information in the slave coordinate system corresponding to the first travel path information of the robot in the base coordinate system and sends it to the robot, so that the robot can autonomously operate according to the converted second travel path information.
  • Driving the method is to convert the driving path information in the base coordinate system to the slave coordinate system of the robot, so as to achieve coordinate unity;
  • the second is that the dispatching platform sends the robot's third travel path information under the base coordinate system to the robot, and the robot determines the position under the base coordinate system corresponding to the current position under the slave coordinate system used for its autonomous positioning. information, so that the robot travels autonomously according to the travel path information in the base coordinate system and the converted position information received from the dispatch platform.
  • the method is to convert the position information of the robot in the slave coordinate system to the base coordinate system, so as to realize Coordinate unity.
  • the coordinate unification method between the two coordinate systems is performed by using the riveting point pair between the two coordinate systems.
  • the coordinates are only performed by rotation and translation.
  • the unified method, the coordinate unified method adopted in the embodiments provided in the examples of this application has higher accuracy, thus improving the safety of different types of robots running together in the same workplace.
  • Embodiment 1 is a flow chart of a method for mixing multi-robots in Embodiment 1 of the present application;
  • Fig. 2 is the flow chart of the method for multi-robot mixed operation according to the second embodiment of the present application
  • Embodiment 3 is a flow chart of a method for multi-robot mixing in Embodiment 3 of the present application
  • Embodiment 4 is a flowchart of a method for multi-robot mixed operation in Embodiment 4 of the present application;
  • Embodiment 5 is a flowchart of a method for multi-robot mixed operation in Embodiment 5 of the present application.
  • FIG. 6 is a flow chart of a method for multi-robot mixing in Embodiment 6 of the present application.
  • Embodiment 9 is a flow chart of a method for multi-robot mixing in Embodiment 8 of the present application.
  • Embodiment 10 is a flow chart of a method for multi-robot mixed operation in Embodiment 9 of the present application.
  • FIG. 11 is a flow chart of a method for multi-robot mixed operation in Embodiment 10 of the present application.
  • Embodiment 13 is a flow chart of a method for multi-robot mixing in Embodiment 12 of the present application.
  • FIG. 14 is a schematic structural diagram of a device for multi-robot mixed operation in Embodiment 1 of the present application.
  • FIG. 15 is a schematic structural diagram of a device for multi-robot mixed operation according to the second embodiment of the present application.
  • the coordinate points of a position point in the world under two coordinate systems form a pair of coordinate points, which is called a pair of riveting points between the two coordinate systems.
  • the coordinate point (a x , a y ) of the position point P in the coordinate system A and the coordinate point ( b x , by ) in the coordinate system B form a pair of coordinate points, which can also be called a rivet point pair.
  • the riveting point pair is a riveting point pair between the coordinate system A and the coordinate system B.
  • an implementation scheme for mixing these robots is provided.
  • the implementation scheme is specifically: on the scheduling platform side, using the basic The set of riveting point pairs between the coordinate system and the slave coordinate system used for autonomous positioning of each robot, and the driving path information of the robot is converted into the driving path information under the slave coordinate system, so that the robot is based on the robot in the slave coordinate system. Drive according to the driving route information under the system.
  • this embodiment essentially uses the base coordinate system and the riveting point between the slave coordinate systems used for autonomous positioning of the robot to perform coordinate transformation on the set, thereby realizing coordinate unification.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace.
  • Intranet security Especially for nonlinear coordinate systems, the effect of improving security is more obvious.
  • FIG. 1 is a flowchart of a method for multi-robot mixed operation in Embodiment 1 of the present application.
  • the method is applied to a scheduling platform, as shown in FIG. 1, and mainly includes the following steps:
  • Step 101 Determine first travel path information of the robot in the base coordinate system.
  • the coordinate system used by the scheduling platform is called the base coordinate system
  • the coordinate system used by the robot for autonomous positioning is called the slave coordinate system. That is, the coordinate system used by the robot itself for positioning and navigation is called the slave coordinate system.
  • the slave coordinate system used for autonomous positioning of the robot is simply referred to as the slave coordinate system of the robot below.
  • the first travel route information is travel route information in the base coordinate system.
  • the first travel route information may be sent to the dispatching platform by other electronic devices.
  • the first travel route information can also be directly input to the dispatching platform by the user.
  • the dispatching platform displays a map under the base coordinate system; the user formulates first travel path information for each robot according to the map displayed on the dispatching platform.
  • Step 102 Determine the slave coordinate system used for autonomous positioning of the robot.
  • the scheduling platform determines the slave coordinate system of the robot.
  • the scheduling platform may send an acquisition instruction to the robot.
  • the robot sends the slave coordinate system of the robot to the dispatching platform according to the obtained instruction.
  • the scheduling platform obtains the slave coordinate system of the robot.
  • slave coordinate systems of multiple robots are pre-stored in the scheduling platform. After determining the first travel path information of a robot, the scheduling platform acquires the slave coordinate system of the robot from the slave coordinate systems of multiple robots stored in advance.
  • the manner in which the scheduling platform determines the slave coordinate system of the robot is not specifically limited.
  • Step 103 using the set of riveting point pairs between the preconfigured base coordinate system and the slave coordinate system, determine the second travel path information in the slave coordinate system corresponding to the first travel path information.
  • the second travel route information is travel route information in the slave coordinate system.
  • the set of rivet point pairs includes at least one rivet point pair.
  • the dispatching platform determines the second travel path information corresponding to the first travel path information by using the set of riveting point pairs between the preconfigured base coordinate system and the secondary coordinate system.
  • Step 104 Send the second travel path information to the robot, so that the robot travels according to the second travel path information.
  • the dispatching platform determines the first travel path information of the robot in the base coordinate system
  • it uses the preconfigured base coordinate system and the automatic positioning method used by the robot to locate the robot.
  • the set of riveting point pairs between the coordinate systems determines the second route travel information in the secondary coordinate system corresponding to the first travel information, so that the robot can travel according to the second travel route information.
  • Coordinate transformation is performed on the set using the riveting points between the base coordinate system and the slave coordinate system to achieve coordinate unification.
  • the coordinate unification method adopted in the implementation provided in the examples of the present application has higher accuracy, so it can improve the ability of different types of robots to mix in the same workplace. safety.
  • the scheduling platform determines the first travel path information of the robot in the base coordinate system, and uses the set of riveting point pairs between the base coordinate system and the slave coordinate system to determine the second travel path corresponding to the first travel path information Path information, the second travel path information is the travel path information in the slave coordinate system.
  • the dispatching platform sends the second travel path information to the robot. After receiving the second travel path information, the robot travels according to the second travel path information.
  • the scheduling platform determines the corresponding travel path information according to the above steps 101-104, so as to realize the unification of the coordinates of the multiple robots, thereby improving the mixing of multiple robots of different types in the same workplace. security.
  • FIG. 2 is a flowchart of a method for multi-robot mixed operation in Embodiment 2 of the present application.
  • the method is applied to a scheduling platform, as shown in FIG. 2, and mainly includes the following steps:
  • Step 201 Determine the first travel path information of the robot in the base coordinate system.
  • the coordinate system used by the scheduling platform is called the base coordinate system
  • the coordinate system used by the robot for autonomous positioning is called the slave coordinate system.
  • the first travel path information of a robot includes: at least one first coordinate point on the first travel path of the robot.
  • the first coordinate point is a coordinate point in the base coordinate system.
  • Step 202 Determine the slave coordinate system used for autonomous positioning of the robot.
  • a set of riveting point pairs between the base coordinate system and the slave coordinate system used for autonomous positioning of each robot may be pre-configured. After determining the first travel path information of the robot in the base coordinate system, the base coordinate system can be determined by searching for the set of riveting point pairs between the pre-configured base coordinate system and the slave coordinate system used by each robot for autonomous positioning. The set of riveting point pairs between the slave coordinate system and the autonomous positioning of the robot.
  • a set of riveting point pairs between the base coordinate system and the slave coordinate systems of each robot is preconfigured in the scheduling platform.
  • the base coordinate system and the slave coordinates of the robot can be determined by searching the set of riveting point pairs between the preconfigured base coordinate system and the slave coordinate systems of each robot.
  • a collection of pairs of riveted points between ties are preconfigured in the scheduling platform.
  • the scheduling platform uses the set of riveting point pairs between the base coordinate system and the slave coordinate system of the robot to determine the first travel
  • the second travel route information corresponding to the route information.
  • the second travel path information is the travel path information of the robot in the slave coordinate system.
  • Step 2031 From the set of riveting point pairs between the base coordinate system and the secondary coordinate system, select a target riveting point pair for coordinate conversion for each first coordinate point included in the first travel path information of the robot .
  • At least one first coordinate point included in the first travel path information At least one first coordinate point included in the first travel path information.
  • the scheduling platform determines the set of riveting point pairs between the base coordinate system and the slave coordinate system of the robot, in the set of riveting point pairs between the base coordinate system and the slave coordinate system of the robot, the The target riveting point pair is selected for each first coordinate point respectively.
  • the pair of target riveting points selected for the first coordinate point is used to perform coordinate transformation on the first coordinate point, so as to convert the first coordinate point into a second coordinate point.
  • the second coordinate point is the coordinate point in the slave coordinate system of the robot.
  • Step 2032 according to the target riveting point pair selected for each first coordinate point included in the first travel path information of the robot, convert the first coordinate point to the corresponding second coordinate in the slave coordinate system point.
  • the second travel path information includes: a second coordinate point.
  • the scheduling platform For each first coordinate point, the scheduling platform converts the first coordinate point into a corresponding second coordinate point according to the target riveting point pair selected for the first coordinate point.
  • Step 2033 Determine the second coordinate point set consisting of the second coordinate points in the slave coordinate system corresponding to each first coordinate point included in the first travel path information of the robot as the second travel path information .
  • the second coordinate point set includes at least one second coordinate point.
  • the scheduling platform determines the second coordinate point set as the second travel path information.
  • steps 2031 to 2033 are specific refinements of step 103 shown in FIG. 1 .
  • Step 204 Send the second travel path information to the robot, so that the robot travels according to the second travel path information.
  • the scheduling platform determines the first travel path information of the robot in the base coordinate system
  • it first selects each first coordinate point included in the first travel path information target riveting point pair, and use the target riveting point pair to determine the second coordinate point in the slave coordinate system corresponding to the first coordinate point, and set the second coordinate point in the slave coordinate system corresponding to all the first coordinate points
  • the set composed of the coordinate points is determined as the second travel path information, so that the robot travels according to the second travel path information.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace. Intranet security.
  • FIG. 3 is a flowchart of a method for multi-robot mixed operation in Embodiment 3 of the present application.
  • the method is applied to a scheduling platform, as shown in FIG. 3, and mainly includes the following steps:
  • Step 301 Determine first travel path information of the robot in the base coordinate system. Step 301 is the same as step 201 and step 101 .
  • Step 302 Determine the slave coordinate system used for autonomous positioning of the robot. Step 302 is the same as step 202 and step 102 .
  • Step 3031 Select N+1 riveting point pairs that satisfy the first condition from the set of riveting point pairs between the base coordinate system and the secondary coordinate system, and determine the N+1 riveting point pairs as the first coordinate point Selected target riveting point pair.
  • the scheduling platform selects N+1 rivet points that satisfy the first condition from the set of rivet point pairs between the base coordinate system and the slave coordinate system of the robot.
  • Point pair, the N+1 riveting point pairs are: the target riveting point pair selected for the first coordinate point.
  • any rivet point pair in the set of rivet point pairs includes a base coordinate point in the base coordinate system and a slave coordinate point in the slave coordinate system corresponding to the base coordinate point. That is, a rivet point pair includes: a base coordinate point and a slave coordinate point, and the two coordinate points included in a rivet point pair correspond to the same position point in the world space.
  • N is the number of dimensions of the base coordinate system.
  • the first condition is: the base coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system having the same dimension as the base coordinate system.
  • the base coordinate system is a linear coordinate system
  • the linear coordinate system that can uniquely determine the base coordinate point in the N+1 riveting point pair is the base coordinate system.
  • the linear coordinate system that can be uniquely determined for the base coordinate point in the N+1 rivet point pair is a coordinate system having the same dimension as the base coordinate system.
  • the linear coordinate system is actually equivalent to a linear coordinate system obtained by linearizing a local area of the base coordinate system.
  • the principle is: although the base coordinate system is nonlinear, the spatial range of the base coordinate system is divided into multiple In the case of small regions, it is approximately linear within each region. This is also the theoretical basis for the subsequent execution of coordinate transformation between the base coordinate system and the slave coordinate system.
  • the above step 3031 is a specific refinement of the step 2031 shown in FIG. 2 .
  • Step 3032 according to the target riveting point pair selected for each first coordinate point included in the first travel path information of the robot, convert the first coordinate point into the corresponding second coordinate in the slave coordinate system point.
  • the second travel path information includes: a second coordinate point.
  • Step 3033 Determine the second coordinate point set consisting of the second coordinate points in the slave coordinate system corresponding to each first coordinate point included in the first travel path information of the robot as the second travel path information .
  • Steps 3032-3033 are the same as steps 2032-2033.
  • the above steps 3031 to 3033 are specific refinements of step 103 shown in FIG. 1 .
  • Step 304 Send the second travel path information to the robot, so that the robot travels according to the second travel path information.
  • the dispatching platform determines the first travel path information of the robot in the base coordinate system, it selects each first coordinate point included in the first travel path information by selecting target riveting point pair, and determine the second coordinate point under the slave coordinate system corresponding to the first coordinate point according to the target riveting point pair, and assign all the first coordinate points corresponding to the second coordinate point under the slave coordinate system
  • the set composed of the coordinate points is determined as the second travel path information, so that the robot travels according to the second travel path information.
  • a target rivet point pair for each first coordinate point included in the first travel path information
  • a rivet point pair that satisfies the first condition is selected as the target rivet point pair.
  • coordinate transformation is performed on the set using the rivet point between the base coordinate system and the slave coordinate system.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace. Intranet security.
  • FIG. 4 is a flowchart of a method for multi-robot mixed operation in Embodiment 4 of the present application. The method is applied to a scheduling platform, as shown in FIG. 4, and mainly includes the following steps:
  • Step 401 Determine the first travel path information of the robot in the base coordinate system. Step 401 is the same as step 201 and step 101 .
  • Step 402 Determine the slave coordinate system used by the robot for autonomous positioning. Step 402 is the same as step 202 and step 102 .
  • Step 4031 Select N+1 riveting point pairs that satisfy the first condition and the second condition from the set of riveting point pairs between the base coordinate system and the slave coordinate system, and determine the N+1 riveting point pairs as the The target riveting point pair selected by the first coordinate point.
  • the scheduling platform selects N satisfying the first condition and the second condition from the set of riveting point pairs between the base coordinate system and the slave coordinate system of the robot.
  • +1 riveting point pair these N+1 riveting point pairs are: the target riveting point pair selected for the first coordinate point.
  • any rivet point pair in the set of rivet point pairs includes a base coordinate point in the base coordinate system and a slave coordinate point in the slave coordinate system corresponding to the base coordinate point.
  • N is the number of dimensions of the base coordinate system.
  • the first condition is: the base coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system having the same dimension as the base coordinate system.
  • the second condition includes at least one of the following conditions:
  • the base coordinate points in the N+1 riveting point pairs are the N+1 base coordinate points closest to the first coordinate point;
  • this first coordinate point is located in the space bounded by the base coordinate point in this N+1 riveting point pair;
  • the preset distance threshold is 2 meters, and the distance between any two base coordinate points in the N+1 riveting point pair is not less than 2 meters.
  • the included angle between the lines connecting the base coordinate points in the N+1 riveting point pair is not less than the preset angle threshold.
  • the preset angle threshold is 10 degrees
  • the included angle between any two base coordinate points in the N+1 riveting point pair is not less than 10 degrees.
  • the theoretical basis of the coordinate transformation described in the above step 3031 can be understood as: the scales within a small spatial range are consistent, therefore, the closer the base coordinate point is to the first coordinate point, the smaller the spatial range and the greater the scale error. Small.
  • the first coordinate point is located within the space range defined by the base coordinate point in the N+1 rivet point pair, which is also to ensure the scale error.
  • the distance between every two base coordinate points is not less than the preset distance threshold, which can reduce the calculation error. If the distance between the two base coordinate points is too short, the scale error in the direction of the side formed by the two base coordinate points will be relatively large.
  • the included angle between the lines connecting the base coordinate points is not less than the preset angle threshold. This is to prevent the three points from collinear and reduce the calculation error.
  • the above step 4031 is a specific refinement of the step 2031 shown in FIG. 2 .
  • Step 4032 according to the target riveting point pair selected for each first coordinate point included in the first travel path information of the robot, convert the first coordinate point into the corresponding second coordinate in the slave coordinate system point.
  • the second travel path information includes: a second coordinate point.
  • Step 4033 Determine the second coordinate point set consisting of the second coordinate points in the slave coordinate system corresponding to each first coordinate point included in the first travel path information of the robot as the second travel path information .
  • Steps 4032-4033 are the same as steps 2032-2033.
  • the above steps 4031 to 4033 are specific refinements of the step 103 shown in FIG. 1 .
  • Step 404 Send the second travel path information to the robot, so that the robot travels according to the second travel path information.
  • the dispatching platform determines the first travel path information of the robot in the base coordinate system
  • it selects the first coordinate point included in the first travel path information by selecting target riveting point pair, and use the target riveting point pair to determine the second coordinate point in the slave coordinate system corresponding to the first coordinate point, and set the second coordinate point in the slave coordinate system corresponding to all the first coordinate points
  • the set composed of the coordinate points is determined as the second travel path information, so that the robot travels according to the second travel path information.
  • a target rivet point pair for each first coordinate point included in the first travel path information a rivet point pair satisfying both the first condition and the second condition is selected as the target rivet point pair.
  • coordinate transformation is performed on the set using the rivet point between the base coordinate system and the slave coordinate system.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace. Intranet security.
  • FIG. 5 is a flowchart of a method for multi-robot mixed operation in Embodiment 5 of the present application. The method is applied to a scheduling platform, as shown in FIG. 5, and mainly includes the following steps:
  • Step 501 Determine the first travel path information of the robot in the base coordinate system. Step 501 is the same as step 201 and step 101 .
  • Step 502 Determine the slave coordinate system used for autonomous positioning of the robot. Step 502 is the same as step 202 and step 102 .
  • Step 5031 From the set of riveting point pairs between the base coordinate system and the secondary coordinate system, select a target riveting point pair for coordinate conversion for each first coordinate point included in the first travel path information of the robot .
  • any rivet point pair in the set of rivet point pairs includes a base coordinate point in a base coordinate system and a slave coordinate point in the slave coordinate system corresponding to the base coordinate point.
  • the second travel path information includes: a second coordinate point.
  • Step 5032a For each first coordinate point, select a first rivet point pair from the target rivet point pair selected for the first coordinate point.
  • the first riveting point pair may be any riveting point pair in the target riveting point pair selected for the first coordinate point.
  • a riveting point pair is selected as the first riveting point pair.
  • a first riveting point pair corresponding to a coordinate point.
  • Step 5032b Determine the first base vector formed by the base coordinate point in the pair of the first coordinate point and the first rivet point
  • first coordinate point and the base coordinate point in the corresponding first rivet point pair form a first base vector
  • the scheduling platform determines the first base vector corresponding to the first coordinate point after determining the first riveting point pair corresponding to the first coordinate point
  • Step 5032c determine N second basis vectors Each second base vector is obtained according to the base coordinate points of any two riveting point pairs in the target riveting point pair selected for the first coordinate point, and the N second base vectors can uniquely represent the base coordinate system.
  • the N second base vectors can uniquely determine the base coordinate system.
  • the N second base vectors are only local regions that can uniquely determine the base coordinate system. Strictly speaking, the N second base vectors should be a linear coordinate system that can be uniquely determined and have the same dimension as the base coordinate system.
  • the scheduling platform determines a second base vector according to the base coordinate points included in the two riveting point pairs.
  • the scheduling platform obtains N second basis vectors corresponding to the first coordinate point in total.
  • the scheduling platform determines N+1 target riveting point pairs corresponding to the first coordinate point, as described in the above-mentioned parts of FIG. 3 and FIG. 4 .
  • Any two rivet point pairs described above may include a first rivet point pair.
  • Step 5032d according to the first basis vector and the N second basis vectors Determine N coefficients ⁇ 1 , ⁇ 2 , ..., ⁇ N , the N coefficients satisfy
  • the scheduling platform determines N coefficients corresponding to the first coordinate point according to the first basis vector and N second basis vectors corresponding to the first coordinate point. Among them, the N coefficients satisfy
  • Step 5032e According to the N coefficients ⁇ 1 , ⁇ 2 , . Coordinate point, the second coordinate point and the first slave vector formed by the slave coordinate point in the first riveting point pair Satisfy in respectively The corresponding second slave vector in the slave coordinate system.
  • the scheduling platform determines the first coordinate point corresponding to the first coordinate point according to the N coefficients corresponding to the first coordinate point and the secondary coordinate point in the first riveting point pair corresponding to the first coordinate point Two coordinate points.
  • the second coordinate point corresponding to the first coordinate point and the slave coordinate point in the first rivet point pair form a first slave vector Satisfy: in, are the slave vectors in the slave coordinate system, respectively, and and correspond.
  • the second base vector corresponds to the second slave vector, which means: the second base vector is determined by two base coordinate points in the pair of two rivet points, and the second slave vector is determined by the two base coordinate points in the pair of two rivet points.
  • a slave coordinate point is determined, and the direction of the second base vector is the same as the direction of the second slave vector.
  • the rivet point pair 1 includes the base coordinate A and the slave coordinate A'
  • the rivet point pair 2 includes the base coordinate B and the slave coordinate B'.
  • the corresponding slave vector is: the slave vector with A' as the start point and B' as the end point.
  • the two-dimensional plane can be expressed by two non-collinear vectors, or two non-collinear vectors can determine an equal-scale two-dimensional plane.
  • the plane is not an equal-scale plane, that is, a nonlinear plane, it cannot be expressed by two non-collinear vectors. Since the scale of SLAM (Simultaneous Localization and Mapping) coordinates in the nonlinear plane is uneven and unknown, it is impossible to express the difference between the two coordinate systems only through two non-collinear vectors. relationship between. However, it can be assumed that the coordinate system is linear within a certain spatial range. The smaller the range is, the smaller the error caused by this assumption will be.
  • the coordinate system can be divided into many regions, and it is assumed that the scale in the region is uniform, and then the relationship between the regions in different coordinate systems is expressed by two non-collinear vectors.
  • the coordinate system can be divided into regions by riveting point pairs, and then two non-collinear vectors in the region can be determined by three riveting point pairs, and then the two vectors can be used to realize the difference between different coordinate systems. Coordinate mapping.
  • point P is the coordinate point to be converted (ie, the first coordinate point).
  • the known information includes: the coordinates of point A-F and point P in the base coordinate system, and the known coordinates of point A'-F' in the slave coordinate system. What needs to be solved is the coordinates of the transformed point P' in the slave coordinate system. The following explains how to solve the coordinates of point P' in the secondary coordinate system.
  • steps 5032a to 5032e are specific refinements of the step 2032 shown in FIG. 2 .
  • Step 5033 Determine the second coordinate point set consisting of the second coordinate points in the secondary coordinate system corresponding to each first coordinate point included in the first travel path information of the robot as the second travel path information .
  • steps 5031 to 5033 are specific refinements of step 103 shown in FIG. 1 .
  • Step 504 Send the second travel path information to the robot, so that the robot travels according to the second travel path information.
  • the dispatching platform determines the first travel path information of the robot in the base coordinate system, it selects each first coordinate point included in the first travel path information by selecting target riveting point pair, and use the target riveting point pair to determine the second coordinate point in the slave coordinate system corresponding to the first coordinate point, and set the second coordinate point in the slave coordinate system corresponding to all the first coordinate points
  • the set composed of the coordinate points is determined as the second travel path information, so that the robot travels according to the second travel path information.
  • the consistency of the vector expression in a certain area between the base coordinate system and the slave coordinate system is used to solve the second coordinate point of each first coordinate point in the slave coordinate system, which can realize non-linear Precise transformation of coordinates between linear coordinate systems.
  • coordinate transformation is performed on the set using the rivet point between the base coordinate system and the slave coordinate system.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace. Intranet security.
  • FIG. 6 is a flowchart of a method for multi-robot mixed operation in Embodiment 6 of the present application. The method is applied to a scheduling platform, as shown in FIG. 6, and mainly includes the following steps:
  • Step 601 Determine the first travel path information of the robot in the base coordinate system. Step 601 is the same as step 201 and step 101 .
  • the first travel path information may include: at least one first coordinate point on the first travel path of the robot, and an azimuth angle used to indicate the heading of the robot at the first coordinate point.
  • Step 602 Determine the slave coordinate system used by the robot for autonomous positioning. Step 602 is the same as step 202 and step 102 .
  • Step 6031 From the set of riveting point pairs between the base coordinate system and the secondary coordinate system, select a target riveting point pair for coordinate conversion for each first coordinate point included in the first travel path information of the robot .
  • Step 6032a for each first coordinate point, select a first rivet point pair from the target rivet point pair selected for the first coordinate point.
  • the first rivet point pair may be any rivet point pair in the target rivet point pair selected for the first coordinate point.
  • Step 6032b Determine the first base vector formed by the base coordinate point in the pair of the first coordinate point and the first rivet point
  • Step 6032c determine N second basis vectors Each second base vector is obtained according to the base coordinate points of any two riveting point pairs in the target riveting point pair selected for the first coordinate point, and the N second base vectors can uniquely represent the base coordinate system.
  • Step 6032d according to the first basis vector and the N second basis vectors Determine N coefficients ⁇ 1 , ⁇ 2 , ..., ⁇ N , the N coefficients satisfy
  • Step 6032e according to the N coefficients ⁇ 1 , ⁇ 2 , .
  • steps 6032a to 6032e are the same as those of the steps 5032a to 5032e shown in FIG. 5 , and will not be repeated here.
  • the second travel path information includes a second coordinate point and an azimuth angle used to indicate the heading of the robot at the second coordinate point.
  • Step 6032f according to the set of riveting point pairs between the base coordinate system and the slave coordinate system, determine the azimuth angle deviation between the base coordinate system and the slave coordinate system, according to the azimuth angle deviation and the azimuth angle of the first coordinate point Determine the azimuth of the second coordinate point.
  • the scheduling platform determines the azimuth deviation between the base coordinate system and the slave coordinate system of the robot according to the set of riveting point pairs between the base coordinate system and the slave coordinate system of the robot. For each first coordinate point of the robot, the scheduling platform determines the azimuth angle of the corresponding second coordinate point according to the determined azimuth angle deviation and the azimuth angle of the first coordinate point.
  • the azimuth deviation between the two coordinate systems is fixed, and the distance between the two vectors formed by the two furthest riveting point pairs in the set of riveting point pairs between the two coordinate systems can be determined between the two
  • the azimuth deviation of is determined as the azimuth deviation between the two coordinate systems.
  • the two vectors formed by the two riveting point pairs can be determined and The azimuth angle deviation between the two is determined as the azimuth angle deviation between the base coordinate system and the slave coordinate system in Fig. 7 .
  • the azimuth angle between the base coordinate system and the slave coordinate system is determined according to the set of riveting point pairs between the base coordinate system and the slave coordinate system Deviation, which can specifically include the following steps:
  • this step S11 can also be implemented by the following method: randomly select two rivet point pairs from the set of rivet point pairs between the base coordinate system and the secondary coordinate system.
  • Step S12 may be: determining the base vector 1 formed by the two base coordinate points in the two riveting point pairs, and determining the secondary vector 1 formed by the two slave coordinate points in the two riveting point pairs, based on the basis vector 1 and from vector 1, determine the azimuth deviation.
  • the azimuth angle deviation between the two coordinate systems is fixed.
  • the azimuth angle deviation between the base coordinate system and the slave coordinate system can be determined according to the above steps S11-S13, and then for each first coordinate point, the azimuth angle deviation and the first coordinate can be directly determined according to the azimuth angle deviation and the first coordinate.
  • the azimuth angle of the point is determined, and the azimuth angle of the corresponding second coordinate point is determined.
  • the above steps S11-S13 only need to be performed once, which saves computing resources.
  • steps 6032a to 6032e are specific refinements of the step 2032 shown in FIG. 2 .
  • Step 6033 Determine the second coordinate point set consisting of the second coordinate points in the slave coordinate system corresponding to each first coordinate point included in the first travel path information of the robot as the second travel path information .
  • steps 6031 to 6033 are specific refinements of step 103 shown in FIG. 1 .
  • Step 604 Send the second travel path information to the robot, so that the robot travels according to the second travel path information.
  • the scheduling platform determines the first travel path information of the robot in the base coordinate system, it selects a target for each first coordinate point in the first travel path information Riveting point pair and using the target riveting point pair to determine the second coordinate point corresponding to the first coordinate point in the slave coordinate system, and assigning all the first coordinate points corresponding to the second coordinate point under the slave coordinate system
  • the formed set is determined to be the second path travel information, so that the robot is based on the second travel path information.
  • the second coordinate point of each first coordinate point in the slave coordinate system can be solved by using the consistency of the expression of vectors in a certain area between the base coordinate system and the slave coordinate system. Precise transformation of coordinates between nonlinear coordinate systems.
  • coordinate transformation is performed on the set using the rivet point between the base coordinate system and the slave coordinate system.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace. Intranet security.
  • FIG. 8 is a flowchart of a method for multi-robot mixed operation in Embodiment 7 of the present application. The method is applied to a scheduling platform, as shown in FIG. 8, and mainly includes the following steps:
  • Step 801 Determine the first travel path information of the robot in the base coordinate system. Step 801 is the same as step 201 and step 101 .
  • Step 802 Determine the slave coordinate system used by the robot for autonomous positioning. Step 802 is the same as step 202 and step 102 .
  • Step 803 Determine the second travel path information in the slave coordinate system corresponding to the first travel path information by using the set of riveting point pairs between the preconfigured base coordinate system and the slave coordinate system.
  • Step 804 Send the second travel path information to the robot, so that the robot travels autonomously according to the second travel path information and the current position information of the robot in the slave coordinate system.
  • the dispatching platform determines the first travel path information of the robot in the base coordinate system
  • it uses the preconfigured base coordinate system and the subordinate coordinate system used for autonomous positioning of the robot.
  • coordinate transformation is performed on the set of riveting points between the base coordinate system and the slave coordinate system to realize coordinate unification.
  • the coordinate unification method adopted in the implementation provided in the examples of the present application has higher accuracy, so it can improve the ability of different types of robots to mix in the same workplace. safety.
  • the implementation is specifically: on the robot side, the current position of the robot Converted to the current position in the base coordinate system, so that the robot can travel autonomously according to the converted current position and the travel path information of the robot in the base coordinate system sent by the dispatching platform.
  • This embodiment uses the riveting points between the slave coordinate system and the base coordinate system used by the robot to perform coordinate transformation on the set, thereby realizing coordinate unification.
  • the coordinate unification method adopted in the implementation provided by the application example has higher accuracy, so it can improve the ability of different types of robots to operate in the same workplace. Mixed security.
  • FIG. 9 is a flowchart of a method for multi-robot mixed operation in Embodiment 8 of the present application. The method is applied to a robot, as shown in FIG. 9, and specifically includes the following steps:
  • Step 901 Receive the third travel path information of the robot in the base coordinate system sent by the scheduling platform.
  • the scheduling platform may send third travel path information to the robot, where the third travel path information is the travel path information in the base coordinate system.
  • the robot receives third travel path information.
  • the dispatching platform obtains the third travel path information reference may be made to the description of the manner in which the first travel path information is obtained in the above step 101, which will not be repeated here.
  • Step 902 Determine the first position information of the robot in the slave coordinate system currently used by the robot for autonomous positioning.
  • the robot determines the current position information of the robot, that is, the first position information.
  • the first position information is the position information in the slave coordinate system of the robot.
  • Step 903 Using the preconfigured set of riveting point pairs between the slave coordinate system and the base coordinate system, determine the second position information in the base coordinate system corresponding to the first position information.
  • step 903 the robot uses the pre-configured set of riveting point pairs between the slave coordinate system and the base coordinate system of the robot to determine the second position information corresponding to the first position information, and the second position information is in the base coordinate system. location information.
  • Step 904 drive autonomously according to the third travel path information and the second position information.
  • the robot uses the pre-configured robot for autonomous positioning. From the set of riveting point pairs between the slave coordinate system and the base coordinate system, determine the second position information in the base coordinate system corresponding to the first position information of the robot, so as to determine the second position information in the base coordinate system according to the third travel path information and the second position information Drive autonomously.
  • coordinate transformation is performed by using the set of riveting point pairs between the slave coordinate system and the base coordinate system to realize coordinate unification.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace. Intranet security.
  • FIG. 10 is a flowchart of a method for multi-robot mixed operation in Embodiment 9 of the present application. The method is applied to a robot, as shown in FIG. 10, and specifically includes the following steps:
  • Step 1001 Receive the third travel path information of the robot in the base coordinate system sent by the scheduling platform.
  • Step 1002 Determine the first position information of the robot in the slave coordinate system currently used by the robot for autonomous positioning.
  • the first location information includes a first location point.
  • Step 10031 From the set of rivet point pairs between the slave coordinate system and the base coordinate system, select a target rivet point pair for coordinate conversion for the first position point in the first position information.
  • step 10031 the robot selects a target rivet point pair for the first position point in the set of rivet point pairs between the slave coordinate system and the base coordinate system of the robot, and the target rivet point pair is used to perform coordinate transformation on the first position point. , to convert the first position point to the second position point.
  • the second position point is the position point in the base coordinate system.
  • the second location information includes a second location point.
  • Step 10032 Convert the first position point to the corresponding second position point in the base coordinate system according to the target riveting point pair selected for the first position point.
  • step 10032 the robot converts the first position point to the second position point according to the target riveting point pair.
  • the above steps 10031 to 10032 are specific refinements of the step 903 shown in FIG. 9 .
  • Step 1004 drive autonomously according to the third travel path information and the second position information.
  • the pre-configured method used for autonomous positioning of the robot After receiving the third travel path information of the robot in the base coordinate system sent by the scheduling platform, the pre-configured method used for autonomous positioning of the robot From the set of riveting point pairs between the coordinate system and the base coordinate system, the target riveting point pair is selected for the first position information, and accordingly the second position information in the base coordinate system corresponding to the first position information is determined.
  • the third travel route information and the second position information drive autonomously.
  • coordinate transformation is performed on the set of riveting points between the coordinate system and the base coordinate system to achieve coordinate unification.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace. Intranet security.
  • FIG. 11 is a flowchart of a method for multi-robot mixed operation in Embodiment 10 of the present application. The method is applied to a robot, as shown in FIG. 11 , and specifically includes the following steps:
  • Step 1101 Receive the third travel path information of the robot in the base coordinate system sent by the scheduling platform.
  • Step 1102 Determine the first position information of the robot in the slave coordinate system currently used by the robot for autonomous positioning.
  • the first location information includes a first location point.
  • Step 11031 Select N+1 riveting point pairs that satisfy the third condition from the set of riveting point pairs between the slave coordinate system and the base coordinate system, and determine the N+1 riveting point pairs as the first position information. The first position point of the selected target riveting point pair.
  • step 11031 the robot selects N+1 riveting point pairs that satisfy the third condition from the set of riveting point pairs between the slave coordinate system and the base coordinate system of the robot, and the N+1 riveting point pairs are: The target riveting point pair selected for the first position point.
  • any riveting point pair in the set of riveting point pairs between the slave coordinate system and the base coordinate system includes: the slave coordinate point in the slave coordinate system and the base coordinate system corresponding to the slave coordinate point The base coordinate point below.
  • N is the number of dimensions of the slave coordinate system.
  • the third condition is: the slave coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system with the same dimension as the slave coordinate system.
  • the linear coordinate system that can uniquely determine the secondary coordinate point in the N+1 rivet point pair is the secondary coordinate system.
  • the linear coordinate system that can uniquely determine the secondary coordinate point in the N+1 rivet point pair is a coordinate system having the same dimension as the secondary coordinate system.
  • the linear coordinate system is actually equivalent to a linear coordinate system obtained by linearizing the local area of the secondary coordinate system.
  • the principle is: although the secondary coordinate system is nonlinear, the spatial range of the secondary coordinate system is divided into In the case of multiple smaller regions, it is approximately linear within each region. This is also the theoretical basis for the subsequent execution of the coordinate transformation between the slave coordinate system and the base coordinate system.
  • the above step 11031 is a specific refinement of the step 10031 shown in FIG. 10 .
  • the second location information includes a second location point.
  • Step 11032 Convert the first position point to the corresponding second position point in the base coordinate system according to the target riveting point pair selected for the first position point.
  • steps 11031 to 11032 are specific refinements of step 903 shown in FIG. 9 .
  • Step 1104 drive autonomously according to the third travel path information and the second position information.
  • step 1104 the robot drives autonomously according to the third travel path information and the second position point.
  • the pre-configured robot autonomous positioning adopts the From the set of riveting point pairs between the coordinate system and the base coordinate system, select the target riveting point pair that satisfies the third condition, and determine the second position information in the base coordinate system corresponding to the first position information accordingly.
  • the third travel route information and the second position information drive autonomously.
  • coordinate transformation is performed on the set of riveting points between the coordinate system and the base coordinate system to achieve coordinate unification.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace. Intranet security.
  • FIG. 12 is a flowchart of a method for multi-robot mixed operation in Embodiment 11 of the present application. The method is applied to a robot, as shown in FIG. 12, and specifically includes the following steps:
  • Step 1201 Receive the third travel path information of the robot in the base coordinate system sent by the scheduling platform.
  • Step 1202 Determine the first position information of the robot in the slave coordinate system currently used by the robot for autonomous positioning.
  • the first location information includes a first location point.
  • Step 12031 Select N+1 riveting point pairs that satisfy the third condition and the fourth condition from the set of riveting point pairs between the slave coordinate system and the base coordinate system, and determine the N+1 riveting point pairs as the first riveting point pair. A pair of target riveting points selected by the first position point in the position information.
  • step 12031 the robot selects N+1 riveting point pairs that satisfy the third and fourth conditions from the set of riveting point pairs between the slave coordinate system and the base coordinate system of the robot. Pair is: the target riveting point pair selected for the first position point.
  • any riveting point pair in the set of riveting point pairs between the slave coordinate system and the base coordinate system includes: the slave coordinate point under the slave coordinate system and the base coordinate under the base coordinate system corresponding to the slave coordinate point point.
  • N is the number of dimensions of the slave coordinate system.
  • the third condition is: the slave coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system with the same dimension as the slave coordinate system;
  • the fourth condition includes at least one of the following conditions:
  • the slave coordinate points in the N+1 riveting point pairs are the N+1 slave coordinate points closest to the first position point;
  • the first position point is located in the space range defined by the slave coordinate point in the N+1 riveting point pair;
  • the preset distance threshold is 2 meters, and the distance between any two slave coordinate points in the N+1 riveting point pair is not less than 2 meters.
  • the included angle between the connecting lines from the coordinate points in the N+1 riveting point pair is not less than the preset angle threshold.
  • the preset angle threshold is 10 degrees
  • the included angle between any two secondary coordinate points in the N+1 riveting point pair is not less than 10 degrees.
  • the above step 12031 is a specific refinement of the step 10031 shown in FIG. 10 .
  • the second location information includes a second location point.
  • Step 12032 Convert the first position point to a corresponding second position point in the base coordinate system according to the target riveting point pair selected for the first position point.
  • steps 12031 to 12032 are specific refinements of step 903 shown in FIG. 9 .
  • Step 1204 drive autonomously according to the third travel path information and the second position information.
  • the second location information includes a second location point.
  • the pre-configured method used for autonomous positioning of the robot is used. From the set of riveting point pairs between the coordinate system and the base coordinate system, select the target riveting point pair that satisfies the third condition and the fourth condition, and determine the second position corresponding to the first position information in the base coordinate system accordingly. information, so as to drive autonomously according to the third travel route information and the second position information.
  • coordinate transformation is performed on the set of riveting points between the coordinate system and the base coordinate system to achieve coordinate unification.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the performance of different types of robots in the same workplace. Intranet security.
  • FIG. 13 is a flowchart of a method for multi-robot mixed operation in Embodiment 12 of the present application. The method is applied to a robot, as shown in FIG. 13, and specifically includes the following steps:
  • Step 1301 Receive the third travel path information of the robot in the base coordinate system sent by the scheduling platform.
  • Step 1302 Determine the first position information of the robot in the slave coordinate system currently used by the robot for autonomous positioning.
  • the first position information includes a first position point and an azimuth angle used to indicate the heading of the robot at the first position point.
  • Step 13031 From the set of rivet point pairs between the slave coordinate system and the base coordinate system, select a target rivet point pair for coordinate conversion for the first position point in the first position information.
  • Step 13032a Select a second rivet point pair from the target rivet point pair selected for the first position point.
  • the second riveting point pair may be any riveting point pair in the target riveting point pair selected for the first position point.
  • step 13032a after selecting the target riveting point pair for the first position point, the robot selects a riveting point pair from these target riveting point pairs as the second riveting point pair.
  • Step 13032b Determine the third slave vector formed by the slave coordinate point in the pair of the first position point and the second rivet point
  • the slave coordinate point in the pair of the first position point and the second rivet point forms the third slave vector After determining the second riveting point pair, the robot determines the third slave vector
  • Step 13032c determine N fourth slave vectors Each fourth slave vector is obtained from the slave coordinate points of any two riveting point pairs in the target riveting point pair selected for the first position point, and the N fourth slave vectors can uniquely represent the slave coordinate system.
  • the N fourth slave vectors can uniquely determine the slave coordinate system of the robot.
  • the N fourth slave vectors are only local regions that can uniquely determine the slave coordinate system of the robot. Strictly speaking, the N fourth slave vectors should be a linear coordinate system that can be uniquely determined to have the same dimension as the slave coordinate system of the robot.
  • the scheduling platform determines a fourth slave vector according to the slave coordinate points included in the two riveting point pairs.
  • the scheduling platform obtains a total of N fourth slave vectors corresponding to the first coordinate point.
  • the scheduling platform determines N+1 target riveting point pairs corresponding to the first position point, as described in the above parts of FIG. 11 and FIG. 12 . Any two rivet point pairs described above may include a second rivet point pair.
  • Step 13032d according to the third slave vector and the N fourth slave vector Determine N coefficients ⁇ 1 , ⁇ 2 , ..., ⁇ N , the N coefficients satisfy
  • Step 13032e According to the N coefficients ⁇ 1 , ⁇ 2 , ..., ⁇ N and the base coordinate point in the second pair of rivet points, determine the second position in the base coordinate system corresponding to the first position point point, the third base vector formed by the second position point and the base coordinate point in the second riveting point pair Satisfy in respectively The corresponding fourth base vector in the base coordinate system.
  • the two-dimensional plane can be expressed by two non-collinear vectors, or two non-collinear vectors can determine an equal-scale two-dimensional plane.
  • the plane is not an equal-scale plane, that is, a nonlinear plane, it cannot be expressed by two non-collinear vectors. Since the scale of SLAM coordinates is non-uniform and unknown in the nonlinear plane, the relationship between the two coordinate systems cannot be expressed only by two non-collinear vectors. However, it can be assumed that the coordinate system is linear within a certain range. The smaller the range is, the smaller the error caused by this assumption will be.
  • the coordinate system can be divided into many regions, and it is assumed that the scale in the region is uniform, and then the relationship between the regions in different coordinate systems is expressed by two non-collinear vectors.
  • the coordinate system can be divided into regions by riveting point pairs, and then two non-collinear vectors in the region can be determined by three riveting point pairs, and then the two vectors can be used to realize the difference between different coordinate systems. Coordinate mapping.
  • Step 13032f according to the set of riveting point pairs between the slave coordinate system and the base coordinate system, determine the azimuth angle deviation between the slave coordinate system and the base coordinate system, and according to the azimuth angle deviation and the azimuth angle of the first position point, Determine the azimuth of the second location point.
  • the azimuth deviation between the two coordinate systems is fixed, and the distance between the two vectors formed by the two furthest riveting point pairs in the set of riveting point pairs between the two coordinate systems can be determined between the two
  • the azimuth deviation of is determined as the azimuth deviation between the two coordinate systems.
  • the two vectors formed by the two riveting point pairs can be determined and The azimuth angle deviation between the two is determined as the azimuth angle deviation between the slave coordinate system and the base coordinate system in FIG. 7 .
  • the robot determines the azimuth deviation between the slave coordinate system and the base coordinate system according to the set of riveting point pairs between the slave coordinate system and the base coordinate system, which may specifically include the following steps:
  • the robot may also randomly select two rivet point pairs from the set of rivet point pairs between the slave coordinate system and the base coordinate system.
  • the azimuth angle deviation between the two coordinate systems is fixed.
  • the azimuth angle deviation between the base coordinate system and the slave coordinate system can be calculated, and then for each first position point, the azimuth angle deviation and the first position can be directly calculated according to the azimuth angle deviation.
  • the azimuth angle of the point is determined, and the azimuth angle of the corresponding second position point is determined.
  • the above steps S21-S23 only need to be performed once, which saves computing resources.
  • steps 13032a to 13032f are specific refinements of the step 10032 shown in FIG. 10 .
  • steps 13031 to 13032f are specific refinements of step 903 shown in FIG. 9 .
  • the second position information includes a second position point and an azimuth angle used to indicate the heading of the robot at the second position point.
  • the coordinates of the second position point and the azimuth angle of the second position point are determined, the coordinates of the second position point and the azimuth angle of the second position point are determined as the second position of the robot in the base coordinate system location information.
  • Step 1304 drive autonomously according to the third travel path information and the second position information.
  • the robot after receiving the third travel path information of the robot in the base coordinate system sent by the dispatching platform, the robot uses the pre-configured robot autonomous positioning method adopted by the robot.
  • the target riveting point pair selected from the set of riveting point pairs between the coordinate system and the base coordinate system converts the first position information into the corresponding second position information under the base coordinate system, so that according to the third travel path information and the second location information to drive autonomously.
  • the second position point of the first position point in the base coordinate system is solved by using the consistency of the expression of the vector in a certain area between the base coordinate system and the slave coordinate system, which can realize nonlinear Precise transformation of coordinates between coordinate systems.
  • coordinate transformation is performed on the set of riveting points between the coordinate system and the base coordinate system to achieve coordinate unification.
  • the coordinate unification method adopted in the implementation provided by the examples of the present application has higher accuracy, so it can improve the accuracy of different types of robots in the same workplace. Intranet security.
  • the embodiment of the present application also provides a device for multi-robot mixed operation, the device is applied to a scheduling platform, and the device includes:
  • a first determining unit configured to determine the first travel path information of the robot in the base coordinate system
  • the second determination unit is used to determine the slave coordinate system used for autonomous positioning of the robot
  • the third determination unit is used to determine the second travel path information under the slave coordinate system corresponding to the first travel path information by using the set of riveting point pairs between the preconfigured base coordinate system and the slave coordinate system;
  • the sending unit is configured to send the second travel path information to the robot, so that the robot travels according to the second travel path information.
  • the robot travels according to the second travel path information, including: the robot travels autonomously according to the second travel path information and the current position information of the robot in the slave coordinate system.
  • the first travel path information includes at least one first coordinate point on the first travel path of the robot
  • the third determining unit can be specifically configured to: in the set of riveting point pairs between the pre-configured base coordinate system and the slave coordinate system, select the riveting point for each first coordinate point included in the first travel path information of the robot. according to the target riveting point pair selected for each first coordinate point included in the first travel path information of the robot, convert the first coordinate point into the corresponding subordinate coordinate system
  • the second coordinate point of the robot; the second coordinate point set consisting of the second coordinate point in the secondary coordinate system corresponding to each first coordinate point included in the first travel path information of the robot is determined as the second travel path information.
  • any riveting point pair in the set of riveting point pairs includes a base coordinate point in a base coordinate system and a slave coordinate point in the slave coordinate system corresponding to the base coordinate point;
  • the third determining unit can be specifically used for: for each first coordinate point, from the set of rivet point pairs between the pre-configured base coordinate system and the secondary coordinate system, select N+1 rivets that satisfy the first condition point pair, the N+1 riveting point pair is determined as the target riveting point pair selected by the first coordinate point; wherein, N is the number of dimensions of the base coordinate system; the first condition is: the N+1 riveting point pair
  • the base coordinate point in can uniquely determine a linear coordinate system with the same dimension as the base coordinate system.
  • any riveting point pair in the set of riveting point pairs includes a base coordinate point in a base coordinate system and a slave coordinate point in the slave coordinate system corresponding to the base coordinate point;
  • the third determination unit can be specifically used for:
  • +1 riveting point pair is determined to be the target riveting point pair selected by the first coordinate point;
  • N is the number of dimensions of the base coordinate system
  • the first condition is: the base coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system with the same dimension as the base coordinate system;
  • the second condition includes at least one of the following conditions:
  • the base coordinate points in the N+1 riveting point pairs are the N+1 base coordinate points closest to the first coordinate point;
  • the first coordinate point is located within the spatial range defined by the base coordinate point in the N+1 riveting point pair;
  • the distance between the base coordinate points in the N+1 riveting point pairs is not less than a preset distance threshold
  • the included angle between the lines connecting the base coordinate points in the N+1 riveting point pair is not less than the preset angle threshold.
  • any riveting point pair in the set of riveting point pairs includes a base coordinate point in a base coordinate system and a slave coordinate point in the slave coordinate system corresponding to the base coordinate point;
  • the third determination unit can be specifically used for:
  • For each first coordinate point use the following steps to convert the first coordinate point into a corresponding second coordinate point in the slave coordinate system: select the first coordinate point from the target riveting point pair selected for the first coordinate point A riveting point pair;
  • Each second base vector is obtained according to the base coordinate points of any two riveting point pairs in the target riveting point pair selected for the first coordinate point, and the N second base vectors can uniquely represent the base coordinate system;
  • the first travel path information further includes: an azimuth for indicating the heading of the robot at the first coordinate point;
  • the second travel path information further includes: an azimuth for indicating the heading of the robot at the second coordinate point;
  • Any riveting point pair in the set of riveting point pairs includes: a base coordinate point under the base coordinate system and a slave coordinate point under the slave coordinate system corresponding to the base coordinate point;
  • the third determination unit can be specifically used for:
  • Each second base vector is obtained according to the base coordinate points of any two riveting point pairs in the target riveting point pair selected for the first coordinate point, and the N second base vectors can uniquely represent the base coordinate system;
  • the first slave vector formed by the slave coordinate point in the pair of the second coordinate point and the first rivet point Satisfy in respectively the corresponding second slave vector in the slave coordinate system;
  • the azimuth angle of the second coordinate point is determined according to the azimuth angle deviation between the base coordinate system and the slave coordinate system, and the azimuth angle of the first coordinate point, and the azimuth angle deviation is determined according to the set of riveting point pairs.
  • the third determining unit can also be used for:
  • the azimuth deviation is determined as the azimuth deviation between the base coordinate system and the slave coordinate system.
  • the embodiment of the present application also provides a device for multi-robot mixed operation, the device is applied to a robot, and the device includes:
  • a receiving unit configured to receive the third travel path information of the robot in the base coordinate system sent by the dispatching platform
  • a fourth determination unit used for determining the first position information of the robot in the slave coordinate system currently used by the robot for autonomous positioning
  • a fifth determining unit configured to use the preconfigured set of riveting point pairs between the slave coordinate system and the base coordinate system to determine the second position information under the base coordinate system corresponding to the first position information
  • the driving unit is used for autonomous driving according to the third driving route information and the second position information.
  • the first location information includes a first location point
  • the fifth determination unit can be specifically used for:
  • the first position point is converted into the corresponding second position point in the base coordinate system.
  • any riveting point pair in the set of riveting point pairs includes: a slave coordinate point in the slave coordinate system and a base coordinate point in the base coordinate system corresponding to the slave coordinate point;
  • the fifth determination unit can be specifically used for:
  • N is the dimension number of the slave coordinate system
  • the third condition is: the slave coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system with the same dimension as the slave coordinate system.
  • any riveting point pair in the set of riveting point pairs includes: a slave coordinate point in the slave coordinate system and a base coordinate point in the base coordinate system corresponding to the slave coordinate point;
  • the fifth determination unit can be specifically used for:
  • N is the dimension number of the slave coordinate system
  • the third condition is: the slave coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system with the same dimension as the slave coordinate system;
  • the fourth condition includes at least one of the following conditions:
  • the slave coordinate points in the N+1 riveting point pair are the N+1 slave coordinate points closest to the first position point;
  • the first position point is located within the spatial range defined by the slave coordinate points in the N+1 riveting point pair;
  • the distance between the slave coordinate points in the N+1 riveting point pairs is not less than a preset distance threshold
  • the included angle between the lines connecting the slave coordinate points in the N+1 riveting point pair is not less than the preset angle threshold.
  • the first position information further includes an azimuth for indicating the heading of the robot at the first position
  • the second position information further includes an azimuth angle for indicating the heading of the robot at the second position point;
  • Any riveting point pair in the set of riveting point pairs includes the slave coordinate point in the slave coordinate system and the base coordinate point in the base coordinate system corresponding to the slave coordinate point;
  • the fifth determination unit can be specifically used for:
  • Each fourth slave vector is obtained according to the slave coordinate points of any two riveting point pairs in the target riveting point pair selected for the first position point, and the N fourth slave vectors can uniquely represent the slave coordinate system;
  • the azimuth angle deviation is determined, and the azimuth angle deviation is determined according to the set of riveting point pairs.
  • the fifth determining unit may be specifically used for:
  • the azimuth deviation is determined as the azimuth deviation between the slave coordinate system and the base coordinate system.
  • the embodiment of the present application also provides an apparatus for multi-robot mixed operation, and the apparatus is applied to a scheduling platform.
  • the apparatus includes: a processor 1401 and a processor 1401 connected to the processor 1401 through a bus non-transitory computer readable storage medium 1402;
  • the non-transitory computer-readable storage medium 1402 stores one or more computer programs executable by the processor 1401; when the processor 1401 executes the one or more computer programs, the following steps are implemented:
  • the second travel path information is sent to the robot, so that the robot travels according to the second travel path information.
  • the robot travels according to the second travel path information, including:
  • the robot travels autonomously according to the second travel path information and the current position information of the robot in the slave coordinate system.
  • the first travel path information includes: at least one first coordinate point on the first travel path of the robot;
  • the processor 1401 uses the set of riveting point pairs between the preconfigured base coordinate system and the slave coordinate system, determines the second travel path information in the slave coordinate system corresponding to the first travel path information, including:
  • a second coordinate point set consisting of second coordinate points in the secondary coordinate system corresponding to each first coordinate point included in the first travel path information of the robot is determined as the second travel path information.
  • any riveting point pair in the set of riveting point pairs includes: a base coordinate point in the base coordinate system and a base coordinate point corresponding to the base coordinate point in the slave coordinate system.
  • the processor 1401 in the set of riveting point pairs between the pre-configured base coordinate system and the slave coordinate system, selects a coordinate point for each first coordinate point included in the first travel path information of the robot.
  • Converted target riveting point pairs including:
  • N is the number of dimensions of the base coordinate system; the first condition is: the base coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system with the same dimension as the base coordinate system.
  • any riveting point pair in the set of riveting point pairs includes: a base coordinate point in the base coordinate system and a base coordinate point corresponding to the base coordinate point in the slave coordinate system.
  • the processor 1401 in the set of riveting point pairs between the pre-configured base coordinate system and the slave coordinate system, selects a coordinate point for each first coordinate point included in the first travel path information of the robot.
  • Converted target riveting point pairs including:
  • N is the dimension number of the base coordinate system
  • the first condition is: the base coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system with the same dimension as the base coordinate system;
  • the second condition includes at least one of the following conditions:
  • the base coordinate points in the N+1 riveting point pairs are the N+1 base coordinate points closest to the first coordinate point;
  • the first coordinate point is located within the spatial range defined by the base coordinate point in the N+1 riveting point pair;
  • the distance between the base coordinate points in the N+1 riveting point pairs is not less than a preset distance threshold
  • the included angle between the lines connecting the base coordinate points in the N+1 riveting point pair is not less than the preset angle threshold.
  • any riveting point pair in the set of riveting point pairs includes: a base coordinate point in the base coordinate system and a base coordinate point corresponding to the base coordinate point in the slave coordinate system.
  • the processor 1401 converts the first coordinate point into the corresponding slave coordinate system.
  • the second coordinate point including:
  • Each second base vector is obtained according to the base coordinate points of any two riveting point pairs in the target riveting point pair selected for the first coordinate point, and the N second base vectors can uniquely represent the base coordinate system;
  • the first travel path information may further include: an azimuth angle used to indicate the heading of the robot at the first coordinate point;
  • the second travel path information further includes: an azimuth angle used to indicate the heading of the robot at the second coordinate point;
  • Any riveting point pair in the set of riveting point pairs includes: a base coordinate point under the base coordinate system and a slave coordinate point corresponding to the base coordinate point under the slave coordinate system;
  • the processor 1401 converts the first coordinate point into the corresponding slave coordinate system.
  • the second coordinate point including:
  • Each second base vector is obtained according to the base coordinate points of any two riveting point pairs in the target riveting point pair selected for the first coordinate point, and the N second base vectors can uniquely represent the base coordinate system;
  • the azimuth angle of the second coordinate point is determined according to the azimuth angle deviation between the base coordinate system and the slave coordinate system, and the azimuth angle of the first coordinate point, and the azimuth angle deviation is determined according to the set of riveting point pairs.
  • the processor 1401 determines the azimuth deviation between the base coordinate system and the slave coordinate system according to the set of rivet point pairs, including:
  • the azimuth deviation is determined as the azimuth deviation between the base coordinate system and the slave coordinate system.
  • the embodiment of the present application also provides another device for multi-robot mixed operation, and the device is applied to robots.
  • the device includes: a processor 1501 and a processor 1501 connected to the processor 1501 through a bus non-transitory computer readable storage medium 1502;
  • the non-transitory computer-readable storage medium 1502 stores one or more computer programs executable by the processor 1501; when the processor 1501 executes the one or more computer programs, the following steps are implemented:
  • the vehicle drives autonomously according to the third travel route information and the second position information.
  • the first position information includes a first position point
  • the processor 1501 uses the preconfigured set of riveting point pairs between the slave coordinate system and the base coordinate system to determine the second position information in the base coordinate system corresponding to the first position information, including:
  • the first position point is converted into the corresponding second position point in the base coordinate system.
  • any riveting point pair in the set of riveting point pairs includes: a slave coordinate point in the slave coordinate system and a base coordinate system corresponding to the slave coordinate point.
  • the processor 1501 in the preconfigured set of riveting point pairs between the slave coordinate system and the base coordinate system, selects a target riveting point pair for coordinate conversion for the first position point in the first position information, including :
  • N is the dimension number of the slave coordinate system
  • the third condition is: the slave coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system with the same dimension as the slave coordinate system.
  • any riveting point pair in the set of riveting point pairs includes: a slave coordinate point in the slave coordinate system and a base coordinate system corresponding to the slave coordinate point.
  • the processor 1501 in the preconfigured set of riveting point pairs between the slave coordinate system and the base coordinate system, selects a target riveting point pair for coordinate conversion for the first position point in the first position information, including :
  • N is the dimension number of the slave coordinate system
  • the third condition is: the slave coordinate point in the N+1 riveting point pair can uniquely determine a linear coordinate system with the same dimension as the slave coordinate system;
  • the fourth condition includes at least one of the following conditions:
  • the slave coordinate points in the N+1 riveting point pair are the N+1 slave coordinate points closest to the first position point;
  • the first position point is located within the spatial range defined by the slave coordinate points in the N+1 riveting point pair;
  • the distance between the slave coordinate points in the N+1 riveting point pairs is not less than a preset distance threshold
  • the included angle between the lines connecting the slave coordinate points in the N+1 riveting point pair is not less than the preset angle threshold.
  • the first position information further includes: an azimuth angle used to indicate the heading of the robot at the first position point;
  • the second position information further includes: an azimuth for indicating the heading of the robot at the second position;
  • Any riveting point pair in the set of riveting point pairs includes: a slave coordinate point under the slave coordinate system and a base coordinate point corresponding to the slave coordinate point under the base coordinate system;
  • the processor 1501 converts the first position point into a corresponding second position point in the base coordinate system, including:
  • Each fourth slave vector is obtained according to the slave coordinate points of any two riveting point pairs in the target riveting point pair selected for the first position point, and the N fourth slave vectors can uniquely represent the slave coordinate system;
  • the azimuth angle deviation is determined, and the azimuth angle deviation is determined according to the set of riveting point pairs.
  • the processor 1501 determines the azimuth deviation between the slave coordinate system and the base coordinate system according to the set of rivet point pairs, including:
  • the azimuth deviation is determined as the azimuth deviation between the slave coordinate system and the base coordinate system.
  • Embodiments of the present application further provide a non-transitory computer-readable storage medium, where the non-transitory computer-readable storage medium stores instructions, and when executed by a processor, the instructions cause the processor to execute as shown in FIG. 1 to FIG. 8
  • the steps in the method for multi-robot mixed operation shown in any one of the flowcharts, or the steps in the method for multi-robot mixed operation shown in any of the flowcharts in FIG. 9 to FIG. 13 are performed.
  • Embodiments of the present application further provide a computer program, which, when executed by a processor, causes the processor to execute the method for multi-robot mixed operation as shown in any of the flowcharts in FIG. 1 to FIG. 8 . , or perform the steps in the method for multi-robot mixed operation as shown in any of the flowcharts in FIG. 9 to FIG. 13 .
  • the above-mentioned embodiments it may be implemented in whole or in part by software, hardware, firmware or any combination thereof.
  • software it can be implemented in whole or in part in the form of a computer program product.
  • the computer program product includes one or more computer instructions. When the computer program instructions are loaded and executed on a computer, all or part of the processes or functions described in the embodiments of the present application are generated.
  • the computer may be a general purpose computer, special purpose computer, computer network, or other programmable device.
  • the computer instructions may be stored in or transmitted from one computer-readable storage medium to another computer-readable storage medium, for example, the computer instructions may be downloaded from a website site, computer, server, or data center Transmission to another website site, computer, server, or data center is by wire (eg, coaxial cable, fiber optic, digital subscriber line (DSL)) or wireless (eg, infrared, wireless, microwave, etc.).
  • the computer-readable storage medium may be any available medium that can be accessed by a computer or a data storage device such as a server, data center, etc. that includes an integration of one or more available media.
  • the usable media may be magnetic media (eg, floppy disks, hard disks, magnetic tapes), optical media (eg, DVD), or semiconductor media (eg, Solid State Disk (SSD)), and the like.

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

一种用于多机器人混行的方法、装置及存储介质,调度平台将机器人在基坐标系下的行驶路径信息转换为该机器人所采用的从坐标系下的行驶路径信息后,将转换后的行驶路径信息发送给该机器人,使得该机器人根据当前位置和转换后的行驶路径信息自主行驶;或者,调度平台将机器人在基坐标系下的行驶路径信息发送给该机器人,该机器人将该机器人在该机器人所采用的从坐标系下的当前位置转换为基坐标系下的当前位置,从而根据转换后的当前位置和从调度平台接收的基坐标系下的行驶路径信息自主行驶。

Description

用于多机器人混行的方法、装置及存储介质
本申请要求于2020年9月30日提交中国专利局、申请号为202011060522.2发明名称为“用于多机器人混行的方法、装置及存储介质”的中国专利申请的优先权,其全部内容通过引用结合在本申请中。
技术领域
本申请涉及机器人技术领域,特别涉及一种用于多机器人混行的方法、装置及存储介质。
背景技术
随着机器人相关技术的迅速发展,机器人在物流、仓储和工厂生产等方面应用越来越普遍。
在实际应用中,经常会存在多种类型的机器人在同一工作场地内共同作业的情况,这多种类型的机器人可能来自于相同厂商,也可能来自于不同厂商。相同厂商的不同类型的机器人自主定位时采用不同的坐标系,不同厂商的机器人自主定位时采用的坐标系也各有不同。由于不同坐标系之间存在坐标系定义、尺度和偏置的差异,因此出现不同类型的机器人之间的坐标不统一的问题。为了实现不同类型的机器人在同一工作场地内的混行,实现统一调度,防止机器人之间发生碰撞,就必须解决不同类型的机器人之间的坐标不统一的问题。
目前,相关技术中坐标统一的方法是:通过旋转和平移的方式将两个坐标系进行对齐。但由于实际应用中的坐标系大部分是非线性坐标系,仅通过旋转和平移是无法精准实现不同类型的机器人之间的坐标统一,导致不同类型的机器人在同一工作场地内混行时容易发生碰撞,造成安全隐患。
发明内容
有鉴于此,本申请的目的在于提供了一种用于多机器人混行的方法、装置及存储介质,以提高不同类型的机器人在同一工作场地内混行的安全性。
为了达到上述目的,本申请实施例提供了如下技术方案:
第一方面,本申请实施例提供了一种用于多机器人混行的方法,应用于调度平台,该方法包括:确定机器人在基坐标系下的第一行驶路径信息;确定所述机器人自主定位时所采用的从坐标系;利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在该从坐标系下的第二行驶路径信息;将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
第二方面,本申请实施例提供了一种用于多机器人混行的方法,应用于机器人,该方法包括:接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息;确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息;利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息;根据第三行驶路径信息和第二位置信息自主行驶。
第三方面,本申请实施例提供了一种用于多机器人混行的装置,应用于调度平台,该装置包括:处理器、以及与所述处理器通过总线相连的非瞬时计算机可读存储介质;所述非瞬时计算机可读存储介质,存储有可被所述处理器执行的一个或多个计算机程序;所述处理器执行所述一个或多个计算机程序时实现以下步骤:确定机器人在基坐标系下的第一行驶路径信息;确定所述机器人自主定位所采用的从坐标系;利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在该从坐标系下的第二行驶路径信息;将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
第四方面,本申请实施例提供了一种用于多机器人混行的装置,应用于机器人,该装置包括:处理器、以及与所述处理器通过总线相连的非瞬时计算机可读存储介质;
所述非瞬时计算机可读存储介质,存储有可被所述处理器执行的一个或多个计算机程序;所述处理器执行所述一个或多个计算机程序时实现以下步骤:接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息;确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息;利 用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息;根据第三行驶路径信息和第二位置信息自主行驶。
第五方面,本申请实施例提供了一种用于多机器人混行的装置,应用于调度平台,该装置包括:第一确定单元,用于确定机器人在基坐标系下的第一行驶路径信息;第二确定单元,用于确定所述机器人自主定位所采用的从坐标系;第三确定单元,用于利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在该从坐标系下的第二行驶路径信息;发送单元,用于将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
第六方面,本申请实施例提供了一种用于多机器人混行的装置,应用于机器人,该装置包括:接收单元,用于接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息;第四确定单元,用于确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息;第五确定单元,用于利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息;行驶单元,用于根据第三行驶路径信息和第二位置信息自主行驶。
第七方面,本申请实施例提供了一种非瞬时计算机可读存储介质,所述非瞬时计算机可读存储介质存储指令,所述指令在由处理器执行时使得所述处理器执行上述第一方面提供的用于多机器人混行的方法中的步骤。
第八方面,本申请实施例提供了一种非瞬时计算机可读存储介质,所述非瞬时计算机可读存储介质存储指令,所述指令在由处理器执行时使得所述处理器执行上述第二方面提供的用于多机器人混行的方法中的步骤。
第九方面,本申请实施例提供了一种计算机程序,所述计算机程序在由处理器执行时使得所述处理器执行上述第一方面提供的用于多机器人混行的方法中的步骤。
第十方面,本申请实施例提供了一种计算机程序,所述计算机程序在由处理器执行时使得所述处理器执行上述第二方面提供的用于多机器人混行的方法中的步骤。
由上面的技术方案可知,本申请实施例中给出了两种实施方法:
第一种是调度平台确定机器人在基坐标系下的第一行驶路径信息对应的从坐标系下的第二行驶路径信息并发送到给机器人,使得该机器人根据转换后的第二行驶路径信息自主行驶,该方法是将基坐标系下的行驶路径信息转换到机器人的从坐标系下,从而实现坐标统一;
第二种是调度平台将机器人在基坐标系下的第三行驶路径信息发送给该机器人,该机器人确定在其自主定位所采用的从坐标系下的当前位置对应的在基坐标系下的位置信息,从而该机器人根据从调度平台接收的基坐标系下的行驶路径信息和转换后的位置信息自主行驶,该方法是将机器人在从坐标系下的位置信息转换到基坐标系下,从而实现坐标统一。
本申请实施例中,利用两个坐标系之间的铆点对进行两个坐标系(特别是非线性坐标系)之间的坐标统一方法,相较于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此提高了不同类型的机器人在同一工作场地内混行的安全性。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本申请实施例一用于多机器人混行的方法流程图;
图2是本申请实施例二用于多机器人混行的方法流程图;
图3是本申请实施例三用于多机器人混行的方法流程图;
图4是本申请实施例四用于多机器人混行的方法流程图;
图5是本申请实施例五用于多机器人混行的方法流程图;
图6是本申请实施例六用于多机器人混行的方法流程图;
图7是本申请实施例基坐标系与从坐标系对比图;
图8是本申请实施例七用于多机器人混行的方法流程图;
图9是本申请实施例八用于多机器人混行的方法流程图;
图10是本申请实施例九用于多机器人混行的方法流程图;
图11是本申请实施例十用于多机器人混行的方法流程图;
图12是本申请实施例十一用于多机器人混行的方法流程图;
图13是本申请实施例十二用于多机器人混行的方法流程图;
图14是本申请实施例一用于多机器人混行的装置的结构示意图;
图15是本申请实施例二用于多机器人混行的装置的结构示意图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
本申请实施例中,将世界中的一个位置点在两个坐标系下的坐标点组成一对坐标点,称为该两个坐标系之间的一个铆点对。例如位置点P在坐标系A中的坐标点(a x,a y)和在坐标系B中的坐标点(b x,b y)组成一对坐标点,也可以称为铆点对。该铆点对是坐标系A与坐标系B之间的一个铆点对。
本申请实施例中,对于在同一工作场景中作业的多个机器人,提供了一种用于这些机器人混行的实施方案,该实施方案具体为:在调度平台一侧,利用调度平台采用的基坐标系与各机器人自主定位所采用的从坐标系之间的铆点对集合,将该机器人的行驶路径信息转换为该从坐标系下的行驶路径信息,使得该机器人根据该机器人在该从坐标系下的行驶路径信息行驶。
可以看出,该实施方案实质上是利用基坐标系和机器人自主定位所采用的从坐标系之间的铆点对集合执行坐标转换,从而实现坐标统一。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。特别是对非线性坐标系,提高安全性的效果更为明显。
以下结合附图对上述实施方案进行详细说明。
参见图1,图1是本申请实施例一用于多机器人混行的方法流程图,该方法应用于调度平台,如图1所示,主要包括以下步骤:
步骤101、确定机器人在基坐标系下的第一行驶路径信息。
本申请实施例中,将调度平台采用的坐标系称为基坐标系,将机器人自主定位所采用的坐标系称为从坐标系。也就是,机器人自身进行定位导航时所采用的坐标系称为从坐标系。为便于描述,以下将机器人自主定位所采用的从坐标系简称为机器人的从坐标系。第一行驶路径信息为在基坐标系下的行驶路径信息。
本申请实施例中,第一行驶路径信息可以为其他电子设备发送给调度平台的。第一行驶路径信息也可以为用户直接输入调度平台的。例如,调度平台显示位于基坐标系下的地图;用户根据调度平台显示的地图,为每个机器人分别制定第一行驶路径信息。
步骤102、确定所述机器人自主定位所采用的从坐标系。
本申请实施例中,当确定一个机器人的第一行驶路径信息后,调度平台确定该机器人的从坐标系。
一个实施例中,调度平台在确定一个机器人的第一行驶路径信息后,可以向该机器人发送获取指令。该机器人根据获取指令将该机器人的从坐标系发送给调度平台。进而调度平台获取到该机器人的从坐标系。
另一个实施例中,调度平台中预先存储了多个机器人的从坐标系。在确定一个机器人的第一行驶路径信息后,调度平台从预先存储的多个机器人的从坐标系中获取该机器人的从坐标系。
本申请实施例中,对调度平台确定机器人的从坐标系的方式不做具体限定。
步骤103、利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在该从坐标系下的第二行驶路径信息。
本申请实施例中,第二行驶路径信为从坐标系下的行驶路径信息。铆点对集合包括至少一个铆点对。调度平台利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的第二行驶路径信息。
步骤104、将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
根据图1所示方法可以看出,本申请实施例中,调度平台确定机器人在基坐标系下的第一行驶路径信息后,利用预先配置的基坐标系与所述机器人自主定位所采用的从坐标系之间的铆点对集合,确定第一行驶信息对应的在该从坐标系下的第二路径行驶信息,从而使得所述机器人可以根据第二行驶路径信息行驶。利用基坐标系和从坐标系之间的铆点对集合执行坐标转换,来实现坐标统一。相对于通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
本申请实施例中,调度平台确定机器人在基坐标系下的第一行驶路径信息,并利用基坐标系与从坐标系之间的铆点对集合,确定第一行驶路径信息对应的第二行驶路径信息,该第二行驶路径信息为从坐标系下的行驶路径信息。调度平台将第二行驶路径信息发送给机器人。机器人接收到第二行驶路径信息后,根据第二行驶路径信息行驶。
本申请实施例中,针对每个机器人,调度平台均按照上述步骤101-104确定相应的行驶路径信息,实现多个机器人的坐标统一,进而提高不同类型的多个机器人在同一工作场地内混行的安全性。
参见图2,图2是本申请实施例二用于多机器人混行的方法流程图,该方法应用于调度平台,如图2所示,主要包括以下步骤:
步骤201、确定机器人在基坐标系下的第一行驶路径信息。
本申请实施例中,将调度平台采用的坐标系称为基坐标系,将机器人自主定位所采用的坐标系称为从坐标系。一个机器人的第一行驶路径信息包括:该机器人的第一行驶路径上的至少一个第一坐标点。第一坐标点为基坐标系下的坐标点。
步骤202、确定所述机器人自主定位所采用的从坐标系。
本申请实施例中,可以预先配置基坐标系与各机器人自主定位所采用的从坐标系之间的铆点对集合。当确定所述机器人在基坐标系下的第一行驶路径信息后,可以通过查找预先配置的基坐标系与各机器人自主定位所采用的从坐标系之间的铆点对集合,确定基坐标系与所述机器人自主定位所采用的从坐标系之间的铆点对集合。
调度平台中预先配置了基坐标系与各机器人的从坐标系之间的铆点对集合。对于一个机器人,当确定该机器人的第一行驶路径信息后,可以通过查找预先配置的基坐标系与各机器人的从坐标系之间的铆点对集合,确定基坐标系与该机器人的从坐标系之间的铆点对集合。
对于一个机器人,调度平台在确定基坐标系与该机器人的从坐标系之间的铆点对集合后,利用基坐标系与该机器人的从坐标系之间的铆点对集合,确定第一行驶路径信息对应的第二行驶路径信息。第二行驶路径信息为该机器人的从坐标系下的行驶路径信息。
步骤2031、在基坐标系与该从坐标系之间的铆点对集合中,为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对。
其中,第一行驶路径信息中包括的至少一个第一坐标点。
对于一个机器人,调度平台确定基坐标系与该机器人的从坐标系之间的铆点对集合后,在基坐标系与该机器人的从坐标系之间的铆点对集合中,为该机器人的每个第一坐标点分别选择目标铆点对。
对于每个第一坐标点,为该第一坐标点选择的目标铆点对用于对该第一坐标点进行坐标转换,以将该第一坐标点转换为第二坐标点。第二坐标点为该机器人的从坐标系下的坐标点。
步骤2032、根据为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点。第二行驶路径信息包括:第二坐标点。
对于每个第一坐标点,调度平台根据为该第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的第二坐标点。
步骤2033、将所述机器人的第一行驶路径信息中包括的每个第一坐标点对应的在该从坐标系下的第二坐标点组成的第二坐标点集合,确定为第二行驶路径信息。
第二坐标点集合包括至少一个第二坐标点。
对于一个机器人,调度平台在确定每个第一坐标点对应的第二坐标点,得到第二坐标点集合后,将第二坐标点集合确定为第二行驶路径信息。
以上步骤2031至步骤2033是图1所示步骤103的具体细化。
步骤204、将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
根据图2所示方法可以看出,本申请实施例中,调度平台确定机器人在基坐标系下的第一行驶路径信息后,先为第一行驶路径信息中包括的每个第一坐标点选择目标铆点对,并利用所述目标铆点对确定该第一坐标点对应的在该从坐标系下的第二坐标点,将所有第一坐标点对应的在该从坐标系下的第二坐标点组成的集合确定为第二路径行驶信息,从而使得所述机器人根据第二行驶路径信息行驶。利用基坐标系和从坐标系之间的铆点对集合执行坐标转换。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
参见图3,图3是本申请实施例三用于多机器人混行的方法流程图,该方法应用于调度平台,如图3所示,主要包括以下步骤:
步骤301、确定机器人在基坐标系下的第一行驶路径信息。步骤301与步骤201和步骤101相同。
步骤302、确定所述机器人自主定位所采用的从坐标系。步骤302与步骤202和步骤102相同。
步骤3031、从基坐标系与该从坐标系之间的铆点对集合中选择满足第一条件的N+1个铆点对,将该N+1个铆点对确定成为该第一坐标点选择的目标铆点对。
本申请实施例中,对于一个机器人的每个第一坐标点,调度平台从基坐标系与该机器人的从坐标系之间的铆点对集合中,选择满足第一条件的N+1个铆点对,这N+1个铆点对即为:为该第一坐标点选择的目标铆点对。
其中,所述铆点对集合中的任一铆点对包括基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点。也就是,一个铆点对包括:一个基坐标点和一个从坐标点,且一个铆点对包括的两个坐标点对应世界空间中的同一位置点。
本申请实施例中,N是基坐标系的维度数。所述第一条件为:该N+1个铆点对中的基坐标点可唯一确定一个与基坐标系具有相同维度的线性坐标系。
这里,如果基坐标系是线性坐标系,则该N+1个铆点对中的基坐标点可唯一确定的线性坐标系就是基坐标系。
如果基坐标系是非线性坐标系,则该N+1个铆点对中的基坐标点可唯一确定的线性坐标系是与基坐标系具有相同维度的坐标系。该线性坐标系实际上相当于将基坐标系的局部区域线性化得到的一个线性坐标系,其原理是:虽然基坐标系是非线性化的,但是将基坐标系的空间范围划分为多个较小的区域的情况下,在每个区域内是近似于线性化的。这也是后续执行基坐标系与从坐标系之间的坐标转换的理论基础。
以上步骤3031是图2所示步骤2031的具体细化。
步骤3032、根据为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点。所述第二行驶路径信息包括:第二坐标点。
步骤3033、将所述机器人的第一行驶路径信息中包括的每个第一坐标点对应的在该从坐标系下的 第二坐标点组成的第二坐标点集合,确定为第二行驶路径信息。
步骤3032-步骤3033与步骤2032-步骤2033相同。以上步骤3031至步骤3033是图1所示步骤103的具体细化。
步骤304、将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
根据图3所示方法可以看出,本申请实施例中,调度平台确定机器人在基坐标系下的第一行驶路径信息后,通过为第一行驶路径信息中包括的每个第一坐标点选择目标铆点对,并根据所述目标铆点对确定该第一坐标点对应的在该从坐标系下的第二坐标点,将所有第一坐标点对应的在该从坐标系下的第二坐标点组成的集合确定为第二路径行驶信息,从而使得所述机器人根据第二行驶路径信息行驶。其中,在为第一行驶路径信息中包括的每个第一坐标点选择目标铆点对时,是选择满足第一条件的铆点对作为目标铆点对。
本申请实施例中,利用基坐标系和从坐标系之间的铆点对集合执行坐标转换。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
参见图4,图4是本申请实施例四用于多机器人混行的方法流程图,该方法应用于调度平台,如图4所示,主要包括以下步骤:
步骤401、确定机器人在基坐标系下的第一行驶路径信息。步骤401与步骤201和步骤101相同。
步骤402、确定所述机器人自主定位所采用的从坐标系。步骤402与步骤202和步骤102相同。
步骤4031、从基坐标系与该从坐标系之间的铆点对集合中选择满足第一条件和第二条件的N+1个铆点对,将该N+1个铆点对确定成为该第一坐标点选择的目标铆点对。
本申请实施例中,对于一个机器人的每个第一坐标点,调度平台从基坐标系与该机器人的从坐标系之间的铆点对集合中,选择满足第一条件和第二条件的N+1个铆点对,这N+1个铆点对即为:为该第一坐标点选择的目标铆点对。
其中,所述铆点对集合中的任一铆点对包括基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点。
本申请实施例中,N是基坐标系的维度数。
所述第一条件为:该N+1个铆点对中的基坐标点可唯一确定一个与基坐标系具有相同维度的线性坐标系。
本申请实施例中,对于每个第一坐标点,所述第二条件包括以下条件中的至少一个:
1)该N+1个铆点对中的基坐标点为距离该第一坐标点最近的N+1个基坐标点;
2)该第一坐标点位于由该N+1个铆点对中的基坐标点界定的空间范围内;
3)该N+1个铆点对中的基坐标点之间的距离不小于预设距离阈值;
例如,预设距离阈值是2米,该N+1个铆点对中的任意两个基坐标点之间的距离都不小于2米。
4)该N+1个铆点对中的基坐标点连线之间的夹角不小于预设角度阈值。
例如,预设角度阈值是10度,该N+1个铆点对中的任意两条基坐标点连线之间的夹角都不小于10度。
上述条件1)中,铆点对中的基坐标点距离该第一坐标点越近越好。上述步骤3031部分描述的坐标转换的理论基础,可以理解为:较小空间范围内的尺度是一致的,因此,基坐标点距离该第一坐标点越近,则空间范围越小,尺度误差越小。
上述条件2)中,该第一坐标点位于由该N+1个铆点对中的基坐标点界定的空间范围内,也是为了保证尺度误差。
上述条件3)中,每两个基坐标点之间的距离不小于预设距离阈值,可以降低计算误差。若两个基坐标点之间的距离过短,则在该两个基坐标点构成的边方向上的尺度误差会比较大。
上述条件4)中,基坐标点连线之间的夹角不小于预设角度阈值。这是为了防止三点共线,降低计 算误差。
以上步骤4031是图2所示步骤2031的具体细化。
步骤4032、根据为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点。所述第二行驶路径信息包括:第二坐标点。
步骤4033、将所述机器人的第一行驶路径信息中包括的每个第一坐标点对应的在该从坐标系下的第二坐标点组成的第二坐标点集合,确定为第二行驶路径信息。
步骤4032-步骤4033与步骤2032-步骤2033相同。以上步骤4031至步骤4033是图1所示步骤103的具体细化。
步骤404、将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
根据图4所示方法可以看出,本申请实施例中,调度平台确定机器人在基坐标系下的第一行驶路径信息后,通过为第一行驶路径信息中包括的每个第一坐标点选择目标铆点对,并利用所述目标铆点对确定该第一坐标点对应的在该从坐标系下的第二坐标点,将所有第一坐标点对应的在该从坐标系下的第二坐标点组成的集合确定为第二路径行驶信息,从而使得所述机器人根据第二行驶路径信息行驶。其中,在为第一行驶路径信息中包括的每个第一坐标点选择目标铆点对时,是选择同时满足第一条件和第二条件的铆点对作为目标铆点对。
本申请实施例中,利用基坐标系和从坐标系之间的铆点对集合执行坐标转换。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
参见图5,图5是本申请实施例五用于多机器人混行的方法流程图,该方法应用于调度平台,如图5所示,主要包括以下步骤:
步骤501、确定机器人在基坐标系下的第一行驶路径信息。步骤501与步骤201和步骤101相同。
步骤502、确定所述机器人自主定位所采用的从坐标系。步骤502与步骤202和步骤102相同。
步骤5031、在基坐标系与该从坐标系之间的铆点对集合中,为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对。
本申请实施例中,所述铆点对集合中的任一铆点对包括基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点。
本申请实施例中,所述第二行驶路径信息包括:第二坐标点。
步骤5032a、针对每个第一坐标点,从为该第一坐标点选择的目标铆点对中选择第一铆点对。
其中,所述第一铆点对可以是为该第一坐标点选择的目标铆点对中的任一铆点对。
本申请实施例中,对于每个第一坐标点,调度平台为该第一坐标点选择一个或多个目标铆点对后,从这些目标铆点对中,选择一个铆点对,作为该第一坐标点对应的第一铆点对。
步骤5032b、确定由该第一坐标点与该第一铆点对中的基坐标点形成的第一基向量
Figure PCTCN2021122158-appb-000001
对于每个第一坐标点,该第一坐标点与对应的第一铆点对中的基坐标点形成第一基向量
Figure PCTCN2021122158-appb-000002
对于每个第一坐标点,调度平台在确定该第一坐标点对应的第一铆点对,确定该第一坐标点对应的第一基向量
Figure PCTCN2021122158-appb-000003
步骤5032c、确定N个第二基向量
Figure PCTCN2021122158-appb-000004
每个第二基向量根据为该第一坐标点选择的目标铆点对中的任两个铆点对的基坐标点得到,且该N个第二基向量可唯一表示基坐标系。
这里,该N个第二基向量可唯一确定基坐标系。实际上,该N个第二基向量只是可以唯一确定基坐标系的局部区域。严格来说,该N个第二基向量应该是可唯一确定与该基坐标系具有相同维度的线性坐标系。
对于每个第一坐标点对应的目标铆点对中任两个铆点对,调度平台根据该两个铆点对包括的基坐标点,确定1个第二基向量。调度平台共得到该第一坐标点对应的N个第二基向量。
一个示例中,对于每个第一坐标点,调度平台确定该第一坐标点对应的N+1个目标铆点对,如上 述图3和图4部分的相关描述。上述任两个铆点对可以包括第一铆点对。
步骤5032d、根据第一基向量
Figure PCTCN2021122158-appb-000005
和该N个第二基向量
Figure PCTCN2021122158-appb-000006
确定N个系数λ 1、λ 2、……、λ N,该N个系数满足
Figure PCTCN2021122158-appb-000007
对于每个第一坐标点,调度平台根据该第一坐标点对应的第一基向量和N个第二基向量,确定该第一坐标点对应的N个系数。其中,这N个系数满足
Figure PCTCN2021122158-appb-000008
步骤5032e、根据该N个系数λ 1、λ 2、……、λ N和所述第一铆点对中的从坐标点,确定该第一坐标点对应的在该从坐标系下的第二坐标点,该第二坐标点与所述第一铆点对中的从坐标点形成的第一从向量
Figure PCTCN2021122158-appb-000009
满足
Figure PCTCN2021122158-appb-000010
其中
Figure PCTCN2021122158-appb-000011
分别是
Figure PCTCN2021122158-appb-000012
对应的在该从坐标系下的第二从向量。
对于每个第一坐标点,调度平台根据该第一坐标点对应的N个系数,以及该第一坐标点对应的第一铆点对中的从坐标点,确定该第一坐标点对应的第二坐标点。
该第一坐标点对应的第二坐标点与第一铆点对中的从坐标点形成第一从向量
Figure PCTCN2021122158-appb-000013
满足:
Figure PCTCN2021122158-appb-000014
其中,
Figure PCTCN2021122158-appb-000015
分别是该从坐标系下的从向量,且
Figure PCTCN2021122158-appb-000016
Figure PCTCN2021122158-appb-000017
Figure PCTCN2021122158-appb-000018
对应。
本申请实施例中,第二基向量与第二从向量对应,表示:第二基向量由两个铆点对中两个基坐标点确定,第二从向量由这两个铆点对中两个从坐标点确定,并且第二基向量的方向和第二从向量的方向相同。例如,铆点对1包括基坐标A和从坐标A’,铆点对2包括基坐标B和从坐标B’。对于以A为起点、B为终点的基向量,其对应的从向量是:以A’为起点、B’为终点的从向量。
以下以二维坐标系为例,对以上步骤5032a至步骤5032e的实现原理进行解释说明。
在实际应用中,若二维平面是等尺度的平面,则二维平面可以通过两个不共线的向量进行表达,或者说两个不共线的向量可以确定一个等尺度二维平面。但若平面不是等尺度的平面,即非线性的平面,则无法通过两个不共线的向量来表达。由于非线性平面中,SLAM(Simultaneous Localization and Mapping,时定位与建图)坐标的尺度是不均匀的并且是未知尺度的,因此无法仅通过两个不共线的向量去表达两个坐标系之间的关系。但可以假设在坐标系的一定空间范围内是线性的,这个范围取的越小,则这个假设带来的误差就越小。
通过上述分析,可以将坐标系划分为很多个区域,并假设在区域内的尺度是均匀的,然后通过两个不共线的向量去表达不同坐标系中这个区域的关系。在实际应用中,可以通过铆点对将坐标系进行区域划分,然后通过3个铆点对确定该区域内的两个不共线向量,然后通过这两个向量实现在不同坐标系之间的坐标映射。
如图7所示,假设左侧为基坐标系,右侧为从坐标系,图7中共有5组铆点对:(A,A')、(B,B')、(C,C')、(E,E')、及(F,F'),点P为待转换坐标点(即第一坐标点)。那么将点P从基坐标系转换到从坐标系时,已知信息有:点A-F及点P在基坐标系中的坐标,已知点A'-F'在从坐标系中的坐标。需要求解的是转换后的点P'在从坐标系中的坐标。下面说明如何求解点P'在从坐标系中的坐标。
首先,为点P选定满足第一条件的3个铆点对作为目标铆点对,如图所示,选定(A,A')、(B,B')和(C,C')为目标铆点对,则可得到如下公式:
Figure PCTCN2021122158-appb-000019
即向量
Figure PCTCN2021122158-appb-000020
可通过向量
Figure PCTCN2021122158-appb-000021
和向量
Figure PCTCN2021122158-appb-000022
表达出来,也可以说是求得点P在向量
Figure PCTCN2021122158-appb-000023
和向量
Figure PCTCN2021122158-appb-000024
组成的坐标系下的坐标为(a,b)。可以理解为,确定的2个系数为a和b。
那么对应到从坐标系中有如下公式:
Figure PCTCN2021122158-appb-000025
此时A'、B'、C'在从坐标系中的坐标已知,并且(a,b)已知,因此可以求解得出P'的坐标,也即点P对应的在从坐标系中的坐标。
以上步骤5032a至步骤5032e是图2所示步骤2032的具体细化。
步骤5033、将所述机器人的第一行驶路径信息中包括的每个第一坐标点对应的在该从坐标系下的第二坐标点组成的第二坐标点集合,确定为第二行驶路径信息。
以上步骤5031至步骤5033是图1所示步骤103的具体细化。
步骤504、将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
根据图5所示方法可以看出,本申请实施例中,调度平台确定机器人在基坐标系下的第一行驶路径信息后,通过为第一行驶路径信息中包括的每个第一坐标点选择目标铆点对,并利用所述目标铆点对确定该第一坐标点对应的在该从坐标系下的第二坐标点,将所有第一坐标点对应的在该从坐标系下的第二坐标点组成的集合确定为第二路径行驶信息,从而使得所述机器人根据第二行驶路径信息行驶。
另外,本申请实施例中,利用基坐标系和从坐标系之间一定区域内的向量表达的一致性,来求解每个第一坐标点在该从坐标系的第二坐标点,可以实现非线性坐标系之间的坐标的精准转换。
本申请实施例中,利用基坐标系和从坐标系之间的铆点对集合执行坐标转换。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
参见图6,图6是本申请实施例六用于多机器人混行的方法流程图,该方法应用于调度平台,如图6所示,主要包括以下步骤:
步骤601、确定机器人在基坐标系下的第一行驶路径信息。步骤601与步骤201和步骤101相同。
本申请实施例中,所述第一行驶路径信息可以包括:所述机器人的第一行驶路径上的至少一个第一坐标点,以及用于指示机器人在第一坐标点的航向的方位角。
步骤602、确定所述机器人自主定位所采用的从坐标系。步骤602与步骤202和步骤102相同。
步骤6031、在基坐标系与该从坐标系之间的铆点对集合中,为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对。
步骤6032a、针对每个第一坐标点,从为该第一坐标点选择的目标铆点对中选择第一铆点对。
这里,所述第一铆点对可以是为该第一坐标点选择的目标铆点对中的任一铆点对。
步骤6032b、确定由该第一坐标点与该第一铆点对中的基坐标点形成的第一基向量
Figure PCTCN2021122158-appb-000026
步骤6032c、确定N个第二基向量
Figure PCTCN2021122158-appb-000027
每个第二基向量根据为该第一坐标点选择的目标铆点对中的任两个铆点对的基坐标点得到,且该N个第二基向量可唯一表示基坐标系。
步骤6032d、根据第一基向量
Figure PCTCN2021122158-appb-000028
和该N个第二基向量
Figure PCTCN2021122158-appb-000029
确定N个系数λ 1、λ 2、……、λ N,该N个系数满足
Figure PCTCN2021122158-appb-000030
步骤6032e、根据该N个系数λ 1、λ 2、……、λ N和所述第一铆点对中的从坐标点,确定该第一坐标点对应的在该从坐标系下的第二坐标点,该第二坐标点与所述第一铆点对中的从坐标点形成的第一从向量
Figure PCTCN2021122158-appb-000031
满足
Figure PCTCN2021122158-appb-000032
其中
Figure PCTCN2021122158-appb-000033
分别是
Figure PCTCN2021122158-appb-000034
对应的在该从坐标系下的第二从向量。
以上步骤6032a至步骤6032e与图5所示步骤5032a至步骤5032e的实现原理相同,不再赘述。
本申请实施例中,所述第二行驶路径信息包括第二坐标点,以及用于指示机器人在第二坐标点的航向的方位角。
步骤6032f、根据基坐标系与该从坐标系之间的铆点对集合,确定基坐标系与该从坐标系之间的方位角偏差,根据该方位角偏差和该第一坐标点的方位角确定该第二坐标点的方位角。
本申请实施例中,对于每个机器人,调度平台根据基坐标系与该机器人的从坐标系之间的铆点对集合,确定基坐标系与该机器人的从坐标系之间的方位角偏差。对于该机器人的每个第一坐标点,调度平台根据所确定的方位角偏差和该第一坐标点的方位角,确定相应的第二坐标点的方位角。
在实际应用中,两个坐标系之间的方位角偏差是固定的,可以将该两个坐标系之间的铆点对集合中距离最远的两个铆点对形成的两个向量之间的方位角偏差确定为该两个坐标系之间的方位角偏差。
例如,假设图7中铆点对(B,B')和铆点对(F,F')之间的距离最远,即BF之间的距离最大和/或B'F'之间的距离最大,则可以确定这两个铆点对形成的两个向量
Figure PCTCN2021122158-appb-000035
Figure PCTCN2021122158-appb-000036
之间的方位角偏差,将此方 位角偏差确定为图7中基坐标系与从坐标系之间的方位角偏差。
因此,在本申请的一个实施例中,对于一个机器人的从坐标系,根据基坐标系与该从坐标系之间的铆点对集合,确定基坐标系与该从坐标系之间的方位角偏差,可具体包括以下步骤:
S11、从基坐标系与该从坐标系之间的铆点对集合中,选择基坐标点之间的距离最远的两个铆点对。这里最远是相对于上述铆点对集合中其他任两个铆点对来说的。
从基坐标系与该从坐标系之间的铆点对集合中,选择基坐标点之间的距离最远的两个铆点对,利用该两个铆点对进行基坐标系与该从坐标系之间的方位角偏差的计算,可使方位角偏差计算结果更加准确。
在实际实现中,本步骤S11也可以采用以下方法实现:从基坐标系与该从坐标系之间的铆点对集合中,随机选择两个铆点对。
S12、确定由该两个铆点对中的两个基坐标点形成的基向量和由该两个基坐标点对应的在从坐标系下的两个从坐标点形成的从向量之间的方位角偏差。
步骤S12可以为:确定由该两个铆点对中的两个基坐标点形成的基向量1,并确定由该两个铆点对中的两个从坐标点形成的从向量1,基于基向量1和从向量1,确定方位角偏差。
S13、将该方位角偏差确定为基坐标系与该从坐标系之间的方位角偏差。
本申请实施例中,两个坐标系之间的方位角偏差是固定的。为了节约计算资源,可以根据上述步骤S11-S13,确定基坐标系与该从坐标系之间的方位角偏差,进而对于每个第一坐标点,可以直接根据该方位角偏差和该第一坐标点的方位角,确定相应的第二坐标点的方位角。这种情况下,只需要执行一次上述步骤S11-S13,节约了计算资源。
以上步骤6032a至步骤6032e是图2所示步骤2032的具体细化。
步骤6033、将所述机器人的第一行驶路径信息中包括的每个第一坐标点对应的在该从坐标系下的第二坐标点组成的第二坐标点集合,确定为第二行驶路径信息。
以上步骤6031至步骤6033是图1所示步骤103的具体细化。
步骤604、将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
根据图6所示方法可以看出,本申请实施例中,调度平台确定机器人在基坐标系下的第一行驶路径信息后,通过为第一行驶路径信息中的每一第一坐标点选择目标铆点对并利用所述目标铆点对确定该第一坐标点对应的在该从坐标系下的第二坐标点,将所有第一坐标点对应的在该从坐标系下的第二坐标点组成的集合确定为第二路径行驶信息,从而使得所述机器人根据第二行驶路径信息。
另外,本申请实施例中,利用基坐标系和从坐标系之间一定区域内的向量的表达的一致性,来求解每一第一坐标点在该从坐标系的第二坐标点,可以实现非线性坐标系之间的坐标的精准转换。
本申请实施例中,利用基坐标系和从坐标系之间的铆点对集合执行坐标转换。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
参见图8,图8是本申请实施例七用于多机器人混行的方法流程图,该方法应用于调度平台,如图8所示,主要包括以下步骤:
步骤801、确定机器人在基坐标系下的第一行驶路径信息。步骤801与步骤201和步骤101相同。
步骤802、确定所述机器人自主定位所采用的从坐标系。步骤802与步骤202和步骤102相同。
步骤803、利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在该从坐标系下的第二行驶路径信息。
步骤804、将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息和所述机器人当前在该从坐标系下的位置信息自主行驶。
根据图8所示方法可以看出,本申请实施例中,调度平台确定机器人在基坐标系下的第一行驶路径信息后,利用预先配置的基坐标系与所述机器人自主定位所采用的从坐标系之间的铆点对集合,确定第一行驶信息对应的在该从坐标系下的第二路径行驶信息,从而使得所述机器人可以根据第二行驶路径信 息和所述机器人的当前位置信息自主行驶。
本申请实施例中,利用基坐标系和从坐标系之间的铆点对集合执行坐标转换来实现坐标统一。相对于通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
本申请实施例中,对于在同一工作场景中作业的多个机器人,还提供另一种用于这些机器人混行的实施方案,该实施方案具体为:在机器人一侧,将该机器人的当前位置转换为基坐标系下的当前位置,从而该机器人可以根据转换后的当前位置和调度平台发送的该机器人在基坐标系下的行驶路径信息自主行驶。
该实施方案是利用机器人所采用的从坐标系和基坐标系之间的铆点对集合执行坐标转换,从而实现坐标统一。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,申请实施例提供的实施方案中所采用的坐标统一的法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
以下结合附图对上述实施方案进行详细说明:
参见图9,图9是本申请实施例八用于多机器人混行的方法流程图,该方法应用于机器人,如图9所示,具体包括以下步骤:
步骤901、接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息。
步骤901中,调度平台可以向机器人发送第三行驶路径信息,第三行驶路径信息为在基坐标系下的行驶路径信息。该机器人接收第三行驶路径信息。调度平台获取第三行驶路径信息的方式,可以参见上述步骤101部分关于获取第一行驶路径信息的方式的描述,此处不再赘述。
步骤902、确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息。
步骤902中,机器人确定该机器人的当前位置信息,即第一位置信息。第一位置信息为在该机器人的从坐标系下的位置信息。
步骤903、利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息。
步骤903中,机器人利用预先配置的该机器人的从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的第二位置信息,第二位置信息为在基坐标系下的位置信息。
步骤904、根据第三行驶路径信息和第二位置信息自主行驶。
根据图9所示方法可以看出,本申请实施例中,机器人接收到调度平台发送的所述机器人在基坐标系下的第三行驶路径信息后,利用预先配置的所述机器人自主定位所采用的从坐标系与基坐标系之间的铆点对集合,确定所述机器人的第一位置信息对应的在基坐标系下的第二位置信息,从而根据第三行驶路径信息和第二位置信息自主行驶。
本申请实施例中,利用从坐标系和基坐标系之间的铆点对集合,执行坐标转换来实现坐标统一。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
参见图10,图10是本申请实施例九用于多机器人混行的方法流程图,该方法应用于机器人,如图10所示,具体包括以下步骤:
步骤1001、接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息。
步骤1002、确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息。
本申请实施例中,所述第一位置信息包括第一位置点。
步骤10031、在该从坐标系与基坐标系之间的铆点对集合中,为第一位置信息中的第一位置点选择用于坐标转换的目标铆点对。
步骤10031中,机器人在该机器人的从坐标系与基坐标系之间的铆点对集合中,为第一位置点选择目标铆点对,目标铆点对用于对第一位置点进行坐标转换,以将第一位置点转换为第二位置点。第二位置点为在基坐标系下的位置点。本申请实施例中,所述第二位置信息包括第二位置点。
步骤10032、根据为第一位置点选择的目标铆点对,将第一位置点转换为对应的在基坐标系下的第二位置点。
步骤10032中,机器人根据目标铆点对,将第一位置点转换为第二位置点。
以上步骤10031至步骤10032是图9所示步骤903的具体细化。
步骤1004、根据第三行驶路径信息和第二位置信息自主行驶。
根据图10所示方法可以看出,本申请实施例中,接收到调度平台发送的所述机器人在基坐标系下的第三行驶路径信息后,在预先配置的所述机器人自主定位所采用的从坐标系与基坐标系之间的铆点对集合中,为第一位置信息选择目标铆点对,并据此确定第一位置信息对应的在基坐标系下的第二位置信息,从而根据第三行驶路径信息和第二位置信息自主行驶。
本申请实施例中,利用从坐标系和基坐标系之间的铆点对集合执行坐标转换来实现坐标统一。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
参见图11,图11是本申请实施例十用于多机器人混行的方法流程图,该方法应用于机器人,如图11所示,具体包括以下步骤:
步骤1101、接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息。
步骤1102、确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息。
本申请实施例中,所述第一位置信息包括第一位置点。
步骤11031、从该从坐标系与基坐标系之间的铆点对集合中选择满足第三条件的N+1个铆点对,将该N+1个铆点对确定成为第一位置信息中的第一位置点选择的目标铆点对。
步骤11031中,机器人从该机器人的从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件的N+1个铆点对,这N+1个铆点对即为:为第一位置点选择的目标铆点对。
本申请实施例中,该从坐标系与基坐标系之间的铆点对集合中的任一铆点对包括:该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点。
本申请实施例中,N是该从坐标系的维度数。所述第三条件为:该N+1个铆点对中的从坐标点可唯一确定一个与该从坐标系具有相同维度的线性坐标系。
这里,如果该从坐标系是线性坐标系,则该N+1个铆点对中的从坐标点可唯一确定的线性坐标系就是该从坐标系。
如果该从坐标系是非线性坐标系,则该N+1个铆点对中的从坐标点可唯一确定的线性坐标系是与该从坐标系具有相同维度的坐标系。该线性坐标系实际上相当于将该从坐标系的局部区域线性化得到的一个线性坐标系,其原理是:虽然该从坐标系是非线性化的,但是将该从坐标系的空间范围划分为多个较小的区域的情况下,在每个区域内是近似于线性化的。这也是后续执行该从坐标系与基坐标系的坐标转换的理论基础。
以上步骤11031是图10所示步骤10031的具体细化。
本申请实施例中,所述第二位置信息包括第二位置点。
步骤11032、根据为第一位置点选择的目标铆点对,将第一位置点转换为对应的在基坐标系下的第二位置点。
以上步骤11031至步骤11032是图9所示步骤903的具体细化。
步骤1104、根据第三行驶路径信息和第二位置信息自主行驶。
步骤1104中,机器人根据第三行驶路径信息和第二位置点自主行驶。
根据图11所示方法可以看出,本申请实施例中,接收到调度平台发送的所述机器人在基坐标系下的第三行驶路径信息后,从预先配置的所述机器人自主定位所采用的从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件的目标铆点对,并据此确定第一位置信息对应的在基坐标系下的第二位置信息,从而根据第三行驶路径信息和第二位置信息自主行驶。
本申请实施例中,利用从坐标系和基坐标系之间的铆点对集合执行坐标转换来实现坐标统一。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
参见图12,图12是本申请实施例十一用于多机器人混行的方法流程图,该方法应用于机器人,如图12所示,具体包括以下步骤:
步骤1201、接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息。
步骤1202、确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息。
本申请实施例中,第一位置信息包括第一位置点。
步骤12031、从该从坐标系与基坐标系之间的铆点对集合中选择满足第三条件和第四条件的N+1个铆点对,将该N+1个铆点对确定成为第一位置信息中的第一位置点选择的目标铆点对。
步骤12031中,机器人从该机器人的从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件和第四条件的N+1个铆点对,这N+1个铆点对即为:为第一位置点选择的目标铆点对。
其中,该从坐标系与基坐标系之间的铆点对集合中的任一铆点对包括:该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点。
本申请实施例中,N是该从坐标系的维度数。
所述第三条件为:该N+1个铆点对中的从坐标点可唯一确定一个与该从坐标系具有相同维度的线性坐标系;
所述第四条件包括以下条件中的至少一个:
1)该N+1个铆点对中的从坐标点为距离第一位置点最近的N+1个从坐标点;
2)第一位置点位于由该N+1个铆点对中的从坐标点界定的空间范围内;
3)该N+1个铆点对中的从坐标点之间的距离不小于预设距离阈值;
例如,预设距离阈值是2米,该N+1个铆点对中的任意两个从坐标点之间的距离都不小于2米。
4)该N+1个铆点对中的从坐标点连线之间的夹角不小于预设角度阈值。
例如,预设角度阈值是10度,该N+1个铆点对中的任意两条从坐标点连线之间的夹角都不小于10度。
以上步骤12031是图10所示步骤10031的具体细化。
本申请实施例中,所述第二位置信息包括第二位置点。
步骤12032、根据为第一位置点选择的目标铆点对,将第一位置点转换为对应的在基坐标系下的第二位置点。
以上步骤12031至步骤12032是图9所示步骤903的具体细化。
步骤1204、根据第三行驶路径信息和第二位置信息自主行驶。
本申请实施例中,第二位置信息包括第二位置点。
根据图12所示方法可以看出,本申请实施例中,接收到调度平台发送的所述机器人在基坐标系下的第三行驶路径信息后,从预先配置的所述机器人自主定位所采用的从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件和第四条件的目标铆点对,并据此确定第一位置信息对应的在基坐标系下的第二位置信息,从而根据第三行驶路径信息和第二位置信息自主行驶。
本申请实施例中,利用从坐标系和基坐标系之间的铆点对集合执行坐标转换来实现坐标统一。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
参见图13,图13是本申请实施例十二用于多机器人混行的方法流程图,该方法应用于机器人,如图13所示,具体包括以下步骤:
步骤1301、接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息。
步骤1302、确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息。
本申请实施例中,第一位置信息包括第一位置点和用于指示机器人在第一位置点的航向的方位角。
步骤13031、在该从坐标系与基坐标系之间的铆点对集合中,为第一位置信息中的第一位置点选择用于坐标转换的目标铆点对。
步骤13032a、从为该第一位置点选择的目标铆点对中选择第二铆点对。
本申请实施例中,所述第二铆点对可以是为该第一位置点选择的目标铆点对中的任一铆点对。
步骤13032a中,机器人为第一位置点选择的目标铆点对后,从这些目标铆点对中选择一个铆点对,作为第二铆点对。
步骤13032b、确定由该第一位置点与该第二铆点对中的从坐标点形成的第三从向量
Figure PCTCN2021122158-appb-000037
第一位置点与第二铆点对中的从坐标点形成第三从向量
Figure PCTCN2021122158-appb-000038
机器人在确定第二铆点对后,确定第三从向量
Figure PCTCN2021122158-appb-000039
步骤13032c、确定N个第四从向量
Figure PCTCN2021122158-appb-000040
每个第四从向量根据为该第一位置点选择的目标铆点对中的任两个铆点对的从坐标点得到,且该N个第四从向量可唯一表示该从坐标系。
这里,该N个第四从向量可唯一确定该机器人的从坐标系。实际上,该N个第四从向量只是可以唯一确定该机器人的从坐标系的局部区域。严格来说,该N个第四从向量应该是可唯一确定与该机器人的从坐标系具有相同维度的线性坐标系。
对于第一位置点对应的目标铆点对中任两个铆点对,调度平台根据该两个铆点对包括的从坐标点,确定1个第四从向量。调度平台共得到该第一坐标点对应的N个第四从向量。
一个示例中,调度平台确定第一位置点对应的N+1个目标铆点对,如上图11和图12部分的描述。上述任两个铆点对可以包括第二铆点对。
步骤13032d、根据第三从向量
Figure PCTCN2021122158-appb-000041
和该N个第四从向量
Figure PCTCN2021122158-appb-000042
确定N个系数γ 1、γ 2、……、γ N,该N个系数满足
Figure PCTCN2021122158-appb-000043
步骤13032e、根据该N个系数γ 1、γ 2、……、γ N和所述第二铆点对中的基坐标点,确定该第一位置点对应的在基坐标系下的第二位置点,该第二位置点与所述第二铆点对中的基坐标点形成的第三基向量
Figure PCTCN2021122158-appb-000044
满足
Figure PCTCN2021122158-appb-000045
其中
Figure PCTCN2021122158-appb-000046
分别是
Figure PCTCN2021122158-appb-000047
对应的在基坐标系下的第四基向量。
以下以二维坐标系为例,对以上步骤13032a至步骤13032e的实现原理进行解释说明:
在实际应用中,若二维平面是等尺度的平面,则二维平面可以通过两个不共线的向量进行表达,或者说两个不共线的向量可以确定一个等尺度二维平面。但若平面不是等尺度的平面,即非线性的平面,则无法通过两个不共线的向量来表达。由于非线性平面中,SLAM坐标的尺度是不均匀的并且是未知尺度的,因此无法仅通过两个不共线的向量去表达两个坐标系之间的关系。但可以假设在坐标系的一定范围内是线性的,这个范围取的越小,则这个假设带来的误差就越小。
通过上述分析,可以将坐标系划分为很多个区域,并假设在区域内的尺度是均匀的,然后通过两个不共线的向量去表达不同坐标系中这个区域的关系。在实际应用中,可以通过铆点对将坐标系进行区域划分,然后通过3个铆点对确定该区域内的两个不共线向量,然后通过这两个向量实现在不同坐标系之间的坐标映射。
仍以图7为例,假设左侧为基坐标系,右侧为从坐标系,图7中共有5组铆点对:(A',A)、(B',B)、(C',C)、(E',E)、及(F',F),点P'为待转换坐标点。那么将点P'从从坐标系转换到基坐标系时,已知信息有:点A'-F'及点P'在从坐标系中的坐标,已知点A-F在基坐标系中的坐标。需要求解的是转换后的点P在基坐标系中的坐标。下面说明如何求解点P在基坐标系中的坐标。
首先,为点P'选定满足第三条件的3个铆点对作为目标铆点对,如图所示,选定(A',A)、(B',B)、(C',C)为目标铆点对,则可得到如下公式:
Figure PCTCN2021122158-appb-000048
即向量
Figure PCTCN2021122158-appb-000049
可通过向量
Figure PCTCN2021122158-appb-000050
和向量
Figure PCTCN2021122158-appb-000051
表达出来,也可以说是求得点P'在向量
Figure PCTCN2021122158-appb-000052
和向量
Figure PCTCN2021122158-appb-000053
组成的坐标系下的坐标为(a,b)。可以 理解为,确定的2个系数为a和b。
那么对应到从坐标系中有如下公式:
Figure PCTCN2021122158-appb-000054
此时A、B、C在基坐标系中的坐标已知,并且(a,b)已知,因此可以求解得出P的坐标,也即点P'对应的在基坐标系中的坐标。
步骤13032f、根据该从坐标系与基坐标系之间的铆点对集合,确定该从坐标系与基坐标系之间的方位角偏差,根据该方位角偏差和第一位置点的方位角,确定第二位置点的方位角。
在实际应用中,两个坐标系之间的方位角偏差是固定的,可以将该两个坐标系之间的铆点对集合中距离最远的两个铆点对形成的两个向量之间的方位角偏差确定为该两个坐标系之间的方位角偏差。
例如,假设图7中铆点对(B,B')和铆点对(F,F')之间的距离最远,即BF之间的距离最大和/或B'F'之间的距离最大,则可以确定这两个铆点对形成的两个向量
Figure PCTCN2021122158-appb-000055
Figure PCTCN2021122158-appb-000056
之间的方位角偏差,将此方位角偏差确定为图7中从坐标系与基坐标系之间的方位角偏差。
因此,本申请的一个实施例中,机器人根据该从坐标系与基坐标系之间的铆点对集合,确定该从坐标系与基坐标系之间的方位角偏差,可具体包括以下步骤:
S21、从该从坐标系与基坐标系之间的铆点对集合中选择从坐标点之间的距离最远的两个铆点对。这里最远是相对于上述铆点对集合中其他任两个铆点对来说的。
一个可选的实施例中,机器人还可以从该从坐标系与基坐标系之间的铆点对集合中,随机选择两个铆点对。
S22、确定由该两个铆点对中的两个从坐标点形成的从向量和由该两个从坐标点对应的在基坐标系下的两个基坐标点形成的基向量之间的方位角偏差。
S23、将该方位角偏差确定为该从坐标系与基坐标系之间的方位角偏差。
本申请实施例中,两个坐标系之间的方位角偏差是固定的。为了节约计算资源,可以根据上述步骤S21-S23,将基坐标系与该从坐标系之间的方位角偏差,进而对于每个第一位置点,可以直接根据该方位角偏差和该第一位置点的方位角,确定相应的第二位置点的方位角。这种情况下,只需要执行一次上述步骤S21-S23,节约了计算资源。
以上步骤13032a至步骤13032f是图10所示步骤10032的具体细化。
以上步骤13031至步骤13032f是图9所示步骤903的具体细化。
其中,所述第二位置信息包括第二位置点和用于指示机器人在第二位置点的航向的方位角。
本申请实施例中,在确定第二位置点的坐标和第二位置点的方位角之后,将第二位置点的坐标和第二位置点的方位角确定为机器人在基坐标系下的第二位置信息。
步骤1304、根据第三行驶路径信息和第二位置信息自主行驶。
根据图13所示方法可以看出,本申请实施例中,接收到调度平台发送的所述机器人在基坐标系下的第三行驶路径信息后,利用从预先配置的所述机器人自主定位所采用的从坐标系与基坐标系之间的铆点对集合中选择的目标铆点对,将第一位置信息转换为对应的在基坐标系下的第二位置信息,从而根据第三行驶路径信息和第二位置信息自主行驶。
另外,本申请实施例中,利用基坐标系和从坐标系之间一定区域内的向量的表达的一致性,来求解第一位置点在基坐标系下的第二位置点,可以实现非线性坐标系之间的坐标的精准转换。
本申请实施例中,利用从坐标系和基坐标系之间的铆点对集合执行坐标转换来实现坐标统一。相对于相关技术中仅通过旋转和平移来进行坐标统一的方法,本申请实施例提供的实施方案中所采用的坐标统一的方法的精准度更高,因此可以提高不同类型的机器人在同一工作场地内混行的安全性。
本申请实施例还提供了一种用于多机器人混行的装置,该装置应用于调度平台,该装置包括:
第一确定单元,用于确定机器人在基坐标系下的第一行驶路径信息;
第二确定单元,用于确定机器人自主定位所采用的从坐标系;
第三确定单元,用于利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径 信息对应的在该从坐标系下的第二行驶路径信息;
发送单元,用于将第二行驶路径信息发送给机器人,以使机器人根据第二行驶路径信息行驶。
一个可选的实施例中,机器人根据第二行驶路径信息行驶,包括:机器人根据第二行驶路径信息和机器人当前在该从坐标系下的位置信息自主行驶。
一个可选的实施例中,第一行驶路径信息包括机器人的第一行驶路径上的至少一个第一坐标点;
第三确定单元,具体可以用于:在预先配置的基坐标系与该从坐标系之间的铆点对集合中,为机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对;根据为机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点;将机器人的第一行驶路径信息中包括的每个第一坐标点对应的在该从坐标系下的第二坐标点组成的第二坐标点集合,确定为第二行驶路径信息。
一个可选的实施例中,铆点对集合中的任一铆点对包括基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
第三确定单元,具体可以用于:针对每个第一坐标点,从预先配置的基坐标系与该从坐标系之间的铆点对集合中,选择满足第一条件的N+1个铆点对,将该N+1个铆点对确定成为该第一坐标点选择的目标铆点对;其中,N是基坐标系的维度数;第一条件为:该N+1个铆点对中的基坐标点可唯一确定一个与基坐标系具有相同维度的线性坐标系。
一个可选的实施例中,铆点对集合中的任一铆点对包括基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
第三确定单元,具体可以用于:
针对每个第一坐标点,从预先配置的基坐标系与该从坐标系之间的铆点对集合中,选择满足第一条件和第二条件的N+1个铆点对,将该N+1个铆点对确定成为该第一坐标点选择的目标铆点对;
其中,N是基坐标系的维度数;第一条件为:该N+1个铆点对中的基坐标点可唯一确定一个与基坐标系具有相同维度的线性坐标系;
第二条件包括以下条件中的至少一个:
该N+1个铆点对中的基坐标点为距离该第一坐标点最近的N+1个基坐标点;
该第一坐标点位于由该N+1个铆点对中的基坐标点界定的空间范围内;
该N+1个铆点对中的基坐标点之间的距离不小于预设距离阈值;以及
该N+1个铆点对中的基坐标点连线之间的夹角不小于预设角度阈值。
一个可选的实施例中,铆点对集合中的任一铆点对包括基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
第三确定单元,具体可以用于:
针对每个第一坐标点,利用以下步骤,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点:从为该第一坐标点选择的目标铆点对中选择第一铆点对;
确定由该第一坐标点与该第一铆点对中的基坐标点形成的第一基向量
Figure PCTCN2021122158-appb-000057
确定N个第二基向量
Figure PCTCN2021122158-appb-000058
每个第二基向量根据为该第一坐标点选择的目标铆点对中的任两个铆点对的基坐标点得到,且该N个第二基向量可唯一表示基坐标系;
根据第一基向量
Figure PCTCN2021122158-appb-000059
和该N个第二基向量
Figure PCTCN2021122158-appb-000060
确定N个系数λ 1、λ 2、……、λ N,该N个系数满足
Figure PCTCN2021122158-appb-000061
根据该N个系数λ 1、λ 2、……、λ N和第一铆点对中的从坐标点,确定该第一坐标点对应的在该从坐标系下的第二坐标点,该第二坐标点与第一铆点对中的从坐标点形成的第一从向量
Figure PCTCN2021122158-appb-000062
满足
Figure PCTCN2021122158-appb-000063
其中
Figure PCTCN2021122158-appb-000064
分别是
Figure PCTCN2021122158-appb-000065
对应的在该从坐标系下的第二从向量。
一个可选的实施例中,第一行驶路径信息还包括:用于指示机器人在第一坐标点的航向的方位角;
第二行驶路径信息还包括:用于指示机器人在第二坐标点的航向的方位角;
铆点对集合中的任一铆点对包括:基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
第三确定单元,具体可以用于:
针对每个第一坐标点,利用以下步骤,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点:
从为该第一坐标点选择的目标铆点对中选择第一铆点对;
确定由该第一坐标点与该第一铆点对中的基坐标点形成的第一基向量
Figure PCTCN2021122158-appb-000066
确定N个第二基向量
Figure PCTCN2021122158-appb-000067
每个第二基向量根据为该第一坐标点选择的目标铆点对中的任两个铆点对的基坐标点得到,且该N个第二基向量可唯一表示基坐标系;
根据第一基向量
Figure PCTCN2021122158-appb-000068
和该N个第二基向量
Figure PCTCN2021122158-appb-000069
确定N个系数λ 1、λ 2、……、λ N,该N个系数满足
Figure PCTCN2021122158-appb-000070
根据该N个系数λ 1、λ 2、……、λ N和第一铆点对中的从坐标点,确定该第一坐标点对应的在该从坐标系下的第二坐标点,该第二坐标点与第一铆点对中的从坐标点形成的第一从向量
Figure PCTCN2021122158-appb-000071
满足
Figure PCTCN2021122158-appb-000072
其中
Figure PCTCN2021122158-appb-000073
分别是
Figure PCTCN2021122158-appb-000074
对应的在该从坐标系下的第二从向量;
根据基坐标系与该从坐标系之间的方位角偏差,以及该第一坐标点的方位角,确定该第二坐标点的方位角,所述方位角偏差是根据铆点对集合确定的。
一个可选的实施例中,第三确定单元,还可以用于:
从铆点对集合中选择基坐标点之间的距离最远的两个铆点对,或者,从所述铆点对集合中随机选择两个铆点对;
确定由该两个铆点对中的两个基坐标点形成的基向量和由该两个基坐标点对应的在从坐标系下的两个从坐标点形成的从向量之间的方位角偏差;
将该方位角偏差确定为基坐标系与该从坐标系之间的方位角偏差。
本申请实施例还提供了一种用于多机器人混行的装置,该装置应用于机器人,该装置包括:
接收单元,用于接收调度平台发送的机器人在基坐标系下的第三行驶路径信息;
第四确定单元,用于确定机器人当前在机器人自主定位所采用的从坐标系下的第一位置信息;
第五确定单元,用于利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息;
行驶单元,用于根据第三行驶路径信息和第二位置信息自主行驶。
一个可选的实施例中,第一位置信息包括第一位置点;
第五确定单元,具体可以用于:
在预先配置的该从坐标系与基坐标系之间的铆点对集合中,为第一位置信息中的第一位置点选择用于坐标转换的目标铆点对;
根据为第一位置点选择的目标铆点对,将第一位置点转换为对应的在基坐标系下的第二位置点。
一个可选的实施例中,铆点对集合中的任一铆点对包括:该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点;
第五确定单元,具体可以用于:
从预先配置的该从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件的N+1个铆点对,将该N+1个铆点对确定成为第一位置点选择的目标铆点对;
其中,N是该从坐标系的维度数;第三条件为:该N+1个铆点对中的从坐标点可唯一确定一个与该从坐标系具有相同维度的线性坐标系。
一个可选的实施例中,铆点对集合中的任一铆点对包括:该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点;
第五确定单元,具体可以用于:
从预先配置的该从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件和第四条件的N+1个铆点对,将该N+1个铆点对确定成为第一位置点选择的目标铆点对;
其中,N是该从坐标系的维度数;第三条件为:该N+1个铆点对中的从坐标点可唯一确定一个与该从坐标系具有相同维度的线性坐标系;
第四条件包括以下条件中的至少一个:
该N+1个铆点对中的从坐标点为距离第一位置点最近的N+1个从坐标点;
第一位置点位于由该N+1个铆点对中的从坐标点界定的空间范围内;
该N+1个铆点对中的从坐标点之间的距离不小于预设距离阈值;以及
该N+1个铆点对中的从坐标点连线之间的夹角不小于预设角度阈值。
一个可选的实施例中,第一位置信息还包括用于指示机器人在第一位置点的航向的方位角;
第二位置信息还包括用于指示机器人在第二位置点的航向的方位角;
铆点对集合中的任一铆点对包括该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点;
第五确定单元,具体可以用于:
从为该第一位置点选择的目标铆点对中选择第二铆点对;
确定由该第一位置点与该第二铆点对中的从坐标点形成的第三从向量
Figure PCTCN2021122158-appb-000075
确定N个第四从向量
Figure PCTCN2021122158-appb-000076
每个第四从向量根据为该第一位置点选择的目标铆点对中的任两个铆点对的从坐标点得到,且该N个第四从向量可唯一表示该从坐标系;
根据第三从向量
Figure PCTCN2021122158-appb-000077
和该N个第四从向量
Figure PCTCN2021122158-appb-000078
确定N个系数γ 1、γ 2、……、γ N,该N个系数满足
Figure PCTCN2021122158-appb-000079
根据该N个系数γ 1、γ 2、……、γ N和第二铆点对中的基坐标点,确定该第一位置点对应的在基坐标系下的第二位置点,该第二位置点与第二铆点对中的基坐标点形成的第三基向量
Figure PCTCN2021122158-appb-000080
满足
Figure PCTCN2021122158-appb-000081
Figure PCTCN2021122158-appb-000082
其中
Figure PCTCN2021122158-appb-000083
分别是
Figure PCTCN2021122158-appb-000084
对应的在基坐标系下的第四基向量;
根据该从坐标系与基坐标系之间的方位角偏差,以及第一位置点的方位角,确定第二位置点的方位角,所述方位角偏差是根据铆点对集合确定的。
一个可选的实施例中,第五确定单元,具体可以用于:
从铆点对集合中,选择从坐标点之间的距离最远的两个铆点对,或者,从铆点对集合中随机选择两个铆点对;
确定由该两个铆点对中的两个从坐标点形成的从向量和由该两个从坐标点对应的在基坐标系下的两个基坐标点形成的基向量之间的方位角偏差;
将该方位角偏差确定为该从坐标系与基坐标系之间的方位角偏差。
本申请实施例还提供了一种用于多机器人混行的装置,该装置应用于调度平台,如图14所示,该装置包括:处理器1401、以及与所述处理器1401通过总线相连的非瞬时计算机可读存储介质1402;
所述非瞬时计算机可读存储介质1402,存储有可被所述处理器1401执行的一个或多个计算机程序;所述处理器1401执行所述一个或多个计算机程序时实现以下步骤:
确定机器人在基坐标系下的第一行驶路径信息;
确定所述机器人自主定位所采用的从坐标系;
利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在该从坐标系下的第二行驶路径信息;
将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
一个可选的实施例中,图14所示装置中,所述机器人根据第二行驶路径信息行驶,包括:
所述机器人根据第二行驶路径信息和所述机器人当前在该从坐标系下的位置信息自主行驶。
一个可选的实施例中,图14所示装置中,所述第一行驶路径信息包括:所述机器人的第一行驶路径上的至少一个第一坐标点;
所述处理器1401,利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在所述从坐标系下的第二行驶路径信息,包括:
在预先配置的基坐标系与该从坐标系之间的铆点对集合中,为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对;
根据为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点;
将所述机器人的第一行驶路径信息中包括的每个第一坐标点对应的在该从坐标系下的第二坐标点组成的第二坐标点集合,确定为第二行驶路径信息。
一个可选的实施例中,图14所示装置中,所述铆点对集合中的任一铆点对包括:基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
所述处理器1401,在预先配置的基坐标系与该从坐标系之间的铆点对集合中,为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对,包括:
从预先配置的基坐标系与该从坐标系之间的铆点对集合中,选择满足第一条件的N+1个铆点对,将该N+1个铆点对确定成为该第一坐标点选择的目标铆点对;
其中,N是基坐标系的维度数;所述第一条件为:该N+1个铆点对中的基坐标点可唯一确定一个与基坐标系具有相同维度的线性坐标系。
一个可选的实施例中,图14所示装置中,所述铆点对集合中的任一铆点对包括:基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
所述处理器1401,在预先配置的基坐标系与该从坐标系之间的铆点对集合中,为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对,包括:
从预先配置的基坐标系与该从坐标系之间的铆点对集合中选择满足第一条件和第二条件的N+1个铆点对,将该N+1个铆点对确定成为该第一坐标点选择的目标铆点对;
其中,N是基坐标系的维度数;所述第一条件为:该N+1个铆点对中的基坐标点可唯一确定一个与基坐标系具有相同维度的线性坐标系;
所述第二条件包括以下条件中的至少一个:
该N+1个铆点对中的基坐标点为距离该第一坐标点最近的N+1个基坐标点;
该第一坐标点位于由该N+1个铆点对中的基坐标点界定的空间范围内;
该N+1个铆点对中的基坐标点之间的距离不小于预设距离阈值;以及
该N+1个铆点对中的基坐标点连线之间的夹角不小于预设角度阈值。
一个可选的实施例中,图14所示装置中,所述铆点对集合中的任一铆点对包括:基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
所述处理器1401,根据为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点,包括:
针对每个第一坐标点,从为该第一坐标点选择的目标铆点对中选择第一铆点对;
确定由该第一坐标点与该第一铆点对中的基坐标点形成的第一基向量
Figure PCTCN2021122158-appb-000085
确定N个第二基向量
Figure PCTCN2021122158-appb-000086
每个第二基向量根据为该第一坐标点选择的目标铆点对中的任两个铆点对的基坐标点得到,且该N个第二基向量可唯一表示基坐标系;
根据第一基向量
Figure PCTCN2021122158-appb-000087
和该N个第二基向量
Figure PCTCN2021122158-appb-000088
确定N个系数λ 1、λ 2、……、λ N,该N个系数满足
Figure PCTCN2021122158-appb-000089
根据该N个系数λ 1、λ 2、……、λ N和所述第一铆点对中的从坐标点,确定该第一坐标点对应的在 该从坐标系下的第二坐标点,该第二坐标点与所述第一铆点对中的从坐标点形成的第一从向量
Figure PCTCN2021122158-appb-000090
满足
Figure PCTCN2021122158-appb-000091
其中
Figure PCTCN2021122158-appb-000092
分别是
Figure PCTCN2021122158-appb-000093
对应的在该从坐标系下的第二从向量。
一个可选的实施例中,图14所示装置中,所述第一行驶路径信息还可以包括:用于指示机器人在第一坐标点的航向的方位角;
所述第二行驶路径信息还包括:用于指示机器人在第二坐标点的航向的方位角;
所述铆点对集合中的任一铆点对包括:基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
所述处理器1401,根据为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点,包括:
针对每个第一坐标点,从为该第一坐标点选择的目标铆点对中选择第一铆点对;
确定由该第一坐标点与该第一铆点对中的基坐标点形成的第一基向量
Figure PCTCN2021122158-appb-000094
确定N个第二基向量
Figure PCTCN2021122158-appb-000095
每个第二基向量根据为该第一坐标点选择的目标铆点对中的任两个铆点对的基坐标点得到,且该N个第二基向量可唯一表示基坐标系;
根据第一基向量
Figure PCTCN2021122158-appb-000096
和该N个第二基向量
Figure PCTCN2021122158-appb-000097
确定N个系数λ 1、λ 2、……、λ N,该N个系数满足
Figure PCTCN2021122158-appb-000098
根据该N个系数λ 1、λ 2、……、λ N和所述第一铆点对中的从坐标点,确定该第一坐标点对应的在该从坐标系下的第二坐标点,该第二坐标点与所述第一铆点对中的从坐标点形成的第一从向量
Figure PCTCN2021122158-appb-000099
满足
Figure PCTCN2021122158-appb-000100
其中
Figure PCTCN2021122158-appb-000101
分别是
Figure PCTCN2021122158-appb-000102
对应的在该从坐标系下的第二从向量;
根据基坐标系与该从坐标系之间的方位角偏差,以及该第一坐标点的方位角,确定该第二坐标点的方位角,所述方位角偏差是根据铆点对集合确定的。
一个可选的实施例中,图14所示装置中,所述处理器1401,根据所述铆点对集合,确定基坐标系与该从坐标系之间的方位角偏差,包括:
从所述铆点对集合中选择基坐标点之间的距离最远的两个铆点对,或者,从所述铆点对集合中随机选择两个铆点对;
确定由该两个铆点对中的两个基坐标点形成的基向量和由该两个基坐标点对应的在从坐标系下的两个从坐标点形成的从向量之间的方位角偏差;
将该方位角偏差确定为基坐标系与该从坐标系之间的方位角偏差。
本申请实施例还提供了另一种用于多机器人混行的装置,该装置应用于机器人,如图15所示,该装置包括:处理器1501、以及与所述处理器1501通过总线相连的非瞬时计算机可读存储介质1502;
所述非瞬时计算机可读存储介质1502,存储有可被所述处理器1501执行的一个或多个计算机程序;所述处理器1501执行所述一个或多个计算机程序时实现以下步骤:
接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息;
确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息;
利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息;
根据第三行驶路径信息和第二位置信息自主行驶。
一个可选的实施例中,图15所示装置中,所述第一位置信息包括第一位置点;
所述处理器1501,利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息,包括:
在预先配置的该从坐标系与基坐标系之间的铆点对集合中,为第一位置信息中的第一位置点选择用于坐标转换的目标铆点对;
根据为第一位置点选择的目标铆点对,将第一位置点转换为对应的在基坐标系下的第二位置点。
一个可选的实施例中,图15所示装置中,所述铆点对集合中的任一铆点对包括:该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点;
所述处理器1501,在预先配置的该从坐标系与基坐标系之间的铆点对集合中,为第一位置信息中的第一位置点选择用于坐标转换的目标铆点对,包括:
从预先配置的该从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件的N+1个铆点对,将该N+1个铆点对确定成为第一位置点选择的目标铆点对;
其中,N是该从坐标系的维度数;所述第三条件为:该N+1个铆点对中的从坐标点可唯一确定一个与该从坐标系具有相同维度的线性坐标系。
一个可选的实施例中,图15所示装置中,所述铆点对集合中的任一铆点对包括:该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点;
所述处理器1501,在预先配置的该从坐标系与基坐标系之间的铆点对集合中,为第一位置信息中的第一位置点选择用于坐标转换的目标铆点对,包括:
从预先配置的该从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件和第四条件的N+1个铆点对,将该N+1个铆点对确定成为第一位置点选择的目标铆点对;
其中,N是该从坐标系的维度数;所述第三条件为:该N+1个铆点对中的从坐标点可唯一确定一个与该从坐标系具有相同维度的线性坐标系;
所述第四条件包括以下条件中的至少一个:
该N+1个铆点对中的从坐标点为距离第一位置点最近的N+1个从坐标点;
第一位置点位于由该N+1个铆点对中的从坐标点界定的空间范围内;
该N+1个铆点对中的从坐标点之间的距离不小于预设距离阈值;以及
该N+1个铆点对中的从坐标点连线之间的夹角不小于预设角度阈值。
一个可选的实施例中,图15所示装置中,所述第一位置信息还包括:用于指示机器人在第一位置点的航向的方位角;
所述第二位置信息还包括:用于指示机器人在第二位置点的航向的方位角;
所述铆点对集合中的任一铆点对包括:该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点;
所述处理器1501,根据为第一位置点选择的目标铆点对,将第一位置点转换为对应的在基坐标系下的第二位置点,包括:
从为该第一位置点选择的目标铆点对中选择第二铆点对
Figure PCTCN2021122158-appb-000103
确定由该第一位置点与该第二铆点对中的从坐标点形成的第三从向量;
确定N个第四从向量
Figure PCTCN2021122158-appb-000104
每个第四从向量根据为该第一位置点选择的目标铆点对中的任两个铆点对的从坐标点得到,且该N个第四从向量可唯一表示该从坐标系;
根据第三从向量
Figure PCTCN2021122158-appb-000105
和该N个第四从向量
Figure PCTCN2021122158-appb-000106
确定N个系数γ 1、γ 2、……、γ N,该N个系数满足
Figure PCTCN2021122158-appb-000107
根据该N个系数γ 1、γ 2、……、γ N和所述第二铆点对中的基坐标点,确定该第一位置点对应的在基坐标系下的第二位置点,该第二位置点与所述第二铆点对中的基坐标点形成的第三基向量
Figure PCTCN2021122158-appb-000108
满足
Figure PCTCN2021122158-appb-000109
其中
Figure PCTCN2021122158-appb-000110
分别是
Figure PCTCN2021122158-appb-000111
对应的在基坐标系下的第四基向量;
根据该从坐标系与基坐标系之间的方位角偏差,以及第一位置点的方位角,确定第二位置点的方位角,所述方位角偏差是根据所述铆点对集合确定的。
一个可选的实施例中,图15所示装置中,所述处理器1501,根据所述铆点对集合,确定该从坐标系与基坐标系之间的方位角偏差,包括:
从所述铆点对集合中,选择从坐标点之间的距离最远的两个铆点对,或者,从所述铆点对集合中随机选择两个铆点对;
确定由该两个铆点对中的两个从坐标点形成的从向量和由该两个从坐标点对应的在基坐标系下的两个基坐标点形成的基向量之间的方位角偏差;
将该方位角偏差确定为该从坐标系与基坐标系之间的方位角偏差。
本申请实施例还提供了一种非瞬时计算机可读存储介质,所述非瞬时计算机可读存储介质存储指令,所述指令在由处理器执行时使得所述处理器执行如图1至图8中任一流程图所示的用于多机器人混行的方法中的步骤,或执行如图9至图13中任一流程图所示的用于多机器人混行的方法中的步骤。
本申请实施例还提供了一种计算机程序,所述计算机程序在由处理器执行时使得所述处理器执行如图1至图8中任一流程图所示的用于多机器人混行的方法中的步骤,或执行如图9至图13中任一流程图所示的用于多机器人混行的方法中的步骤。
在上述实施例中,可以全部或部分地通过软件、硬件、固件或者其任意组合来实现。当使用软件实现时,可以全部或部分地以计算机程序产品的形式实现。所述计算机程序产品包括一个或多个计算机指令。在计算机上加载和执行所述计算机程序指令时,全部或部分地产生按照本申请实施例所述的流程或功能。所述计算机可以是通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算机指令可以存储在计算机可读存储介质中,或者从一个计算机可读存储介质向另一个计算机可读存储介质传输,例如,所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(DSL))或无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据中心进行传输。所述计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。所述可用介质可以是磁性介质,(例如,软盘、硬盘、磁带)、光介质(例如,DVD)、或者半导体介质(例如固态硬盘Solid State Disk(SSD))等。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中的各个实施例均采用相关的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于装置、存储介质和计算机程序实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
以上所述仅为本申请的较佳实施例,并不用以限制本申请,凡在本申请的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本申请保护的范围之内。

Claims (20)

  1. 一种用于多机器人混行的方法,应用于调度平台,该方法包括:
    确定机器人在基坐标系下的第一行驶路径信息;
    确定所述机器人自主定位所采用的从坐标系;
    利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在该从坐标系下的第二行驶路径信息;
    将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
  2. 根据权利要求1所述的方法,其中,所述机器人根据第二行驶路径信息行驶,包括:
    所述机器人根据第二行驶路径信息和所述机器人当前在该从坐标系下的位置信息自主行驶。
  3. 根据权利要求1所述的方法,其中,所述第一行驶路径信息包括所述机器人的第一行驶路径上的至少一个第一坐标点;
    所述利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在所述从坐标系下的第二行驶路径信息,包括:
    在预先配置的基坐标系与该从坐标系之间的铆点对集合中,为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对;
    根据为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点;
    将所述机器人的第一行驶路径信息中包括的每个第一坐标点对应的在该从坐标系下的第二坐标点组成的第二坐标点集合,确定为第二行驶路径信息。
  4. 根据权利要求3所述的方法,其中,所述铆点对集合中的任一铆点对包括基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
    所述在预先配置的基坐标系与该从坐标系之间的铆点对集合中,为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对,包括:
    针对每个第一坐标点,从预先配置的基坐标系与该从坐标系之间的铆点对集合中,选择满足第一条件的N+1个铆点对,将该N+1个铆点对确定成为该第一坐标点选择的目标铆点对;
    其中,N是基坐标系的维度数;所述第一条件为:该N+1个铆点对中的基坐标点可唯一确定一个与基坐标系具有相同维度的线性坐标系。
  5. 根据权利要求3所述的方法,其中,所述铆点对集合中的任一铆点对包括基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
    所述在预先配置的基坐标系与该从坐标系之间的铆点对集合中,为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择用于坐标转换的目标铆点对,包括:
    针对每个第一坐标点,从预先配置的基坐标系与该从坐标系之间的铆点对集合中,选择满足第一条件和第二条件的N+1个铆点对,将该N+1个铆点对确定成为该第一坐标点选择的目标铆点对;
    其中,N是基坐标系的维度数;所述第一条件为:该N+1个铆点对中的基坐标点可唯一确定一个与基坐标系具有相同维度的线性坐标系;
    所述第二条件包括以下条件中的至少一个:
    该N+1个铆点对中的基坐标点为距离该第一坐标点最近的N+1个基坐标点;
    该第一坐标点位于由该N+1个铆点对中的基坐标点界定的空间范围内;
    该N+1个铆点对中的基坐标点之间的距离不小于预设距离阈值;以及
    该N+1个铆点对中的基坐标点连线之间的夹角不小于预设角度阈值。
  6. 根据权利要求3所述的方法,其中,所述铆点对集合中的任一铆点对包括基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
    所述根据为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一 坐标点转换为对应的在该从坐标系下的第二坐标点,包括:
    针对每个第一坐标点,利用以下步骤,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点:
    从为该第一坐标点选择的目标铆点对中选择第一铆点对;
    确定由该第一坐标点与该第一铆点对中的基坐标点形成的第一基向量
    Figure PCTCN2021122158-appb-100001
    确定N个第二基向量
    Figure PCTCN2021122158-appb-100002
    每个第二基向量根据为该第一坐标点选择的目标铆点对中的任两个铆点对的基坐标点得到,且该N个第二基向量可唯一表示基坐标系;
    根据第一基向量
    Figure PCTCN2021122158-appb-100003
    和该N个第二基向量
    Figure PCTCN2021122158-appb-100004
    确定N个系数λ 1、λ 2、……、λ N,该N个系数满足
    Figure PCTCN2021122158-appb-100005
    根据该N个系数λ 1、λ 2、……、λ N和所述第一铆点对中的从坐标点,确定该第一坐标点对应的在该从坐标系下的第二坐标点,该第二坐标点与所述第一铆点对中的从坐标点形成的第一从向量
    Figure PCTCN2021122158-appb-100006
    满足
    Figure PCTCN2021122158-appb-100007
    其中
    Figure PCTCN2021122158-appb-100008
    分别是
    Figure PCTCN2021122158-appb-100009
    对应的在该从坐标系下的第二从向量。
  7. 根据权利要求3所述的方法,其中,所述第一行驶路径信息还包括:用于指示机器人在第一坐标点的航向的方位角;
    所述第二行驶路径信息还包括:用于指示机器人在第二坐标点的航向的方位角;
    所述铆点对集合中的任一铆点对包括:基坐标系下的基坐标点和该基坐标点对应的在该从坐标系下的从坐标点;
    所述根据为所述机器人的第一行驶路径信息中包括的每个第一坐标点选择的目标铆点对,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点,包括:
    针对每个第一坐标点,利用以下步骤,将该第一坐标点转换为对应的在该从坐标系下的第二坐标点:
    从为该第一坐标点选择的目标铆点对中选择第一铆点对;
    确定由该第一坐标点与该第一铆点对中的基坐标点形成的第一基向量
    Figure PCTCN2021122158-appb-100010
    确定N个第二基向量
    Figure PCTCN2021122158-appb-100011
    每个第二基向量根据为该第一坐标点选择的目标铆点对中的任两个铆点对的基坐标点得到,且该N个第二基向量可唯一表示基坐标系;
    根据第一基向量
    Figure PCTCN2021122158-appb-100012
    和该N个第二基向量
    Figure PCTCN2021122158-appb-100013
    确定N个系数λ 1、λ 2、……、λ N,该N个系数满足
    Figure PCTCN2021122158-appb-100014
    根据该N个系数λ 1、λ 2、……、λ N和所述第一铆点对中的从坐标点,确定该第一坐标点对应的在该从坐标系下的第二坐标点,该第二坐标点与所述第一铆点对中的从坐标点形成的第一从向量
    Figure PCTCN2021122158-appb-100015
    满足
    Figure PCTCN2021122158-appb-100016
    其中
    Figure PCTCN2021122158-appb-100017
    分别是
    Figure PCTCN2021122158-appb-100018
    对应的在该从坐标系下的第二从向量;
    根据基坐标系与该从坐标系之间的方位角偏差,以及该第一坐标点的方位角,确定该第二坐标点的方位角,所述方位角偏差是根据所述铆点对集合确定的。
  8. 根据权利要求7所述的方法,其中,所述方位角偏差采用如下步骤确定:
    从所述铆点对集合中,选择基坐标点之间的距离最远的两个铆点对,或者,从所述铆点对集合中随机选择两个铆点对;
    确定由该两个铆点对中的两个基坐标点形成的基向量和由该两个基坐标点对应的在从坐标系下的两个从坐标点形成的从向量之间的方位角偏差;
    将该方位角偏差确定为基坐标系与该从坐标系之间的方位角偏差。
  9. 一种用于多机器人混行的方法,应用于机器人,该方法包括:
    接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息;
    确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息;
    利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下 的第二位置信息;
    根据第三行驶路径信息和第二位置信息自主行驶。
  10. 根据权利要求9所述的方法,其中,所述第一位置信息包括第一位置点;
    所述利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息,包括:
    在预先配置的该从坐标系与基坐标系之间的铆点对集合中,为第一位置信息中的第一位置点选择用于坐标转换的目标铆点对;
    根据为第一位置点选择的目标铆点对,将第一位置点转换为对应的在基坐标系下的第二位置点。
  11. 根据权利要求10所述的方法,其中,所述铆点对集合中的任一铆点对包括:该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点;
    所述在预先配置的该从坐标系与基坐标系之间的铆点对集合中,为第一位置信息中的第一位置点选择用于坐标转换的目标铆点对,包括:
    从预先配置的该从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件的N+1个铆点对,将该N+1个铆点对确定成为第一位置点选择的目标铆点对;
    其中,N是该从坐标系的维度数;所述第三条件为:该N+1个铆点对中的从坐标点可唯一确定一个与该从坐标系具有相同维度的线性坐标系。
  12. 根据权利要求10所述的方法,其中,所述铆点对集合中的任一铆点对包括:该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点;
    所述在预先配置的该从坐标系与基坐标系之间的铆点对集合中,为第一位置信息中的第一位置点选择用于坐标转换的目标铆点对,包括:
    从预先配置的该从坐标系与基坐标系之间的铆点对集合中,选择满足第三条件和第四条件的N+1个铆点对,将该N+1个铆点对确定成为第一位置点选择的目标铆点对;
    其中,N是该从坐标系的维度数;所述第三条件为:该N+1个铆点对中的从坐标点可唯一确定一个与该从坐标系具有相同维度的线性坐标系;
    所述第四条件包括以下条件中的至少一个:
    该N+1个铆点对中的从坐标点为距离第一位置点最近的N+1个从坐标点;
    第一位置点位于由该N+1个铆点对中的从坐标点界定的空间范围内;
    该N+1个铆点对中的从坐标点之间的距离不小于预设距离阈值;以及
    该N+1个铆点对中的从坐标点连线之间的夹角不小于预设角度阈值。
  13. 根据权利要求10所述的方法,其中,所述第一位置信息还包括用于指示机器人在第一位置点的航向的方位角;
    所述第二位置信息还包括用于指示机器人在第二位置点的航向的方位角;
    所述铆点对集合中的任一铆点对包括该从坐标系下的从坐标点和该从坐标点对应的在基坐标系下的基坐标点;
    所述根据为第一位置点选择的目标铆点对,将第一位置点转换为对应的在基坐标系下的第二位置点,包括:
    从为该第一位置点选择的目标铆点对中选择第二铆点对;
    确定由该第一位置点与该第二铆点对中的从坐标点形成的第三从向量
    Figure PCTCN2021122158-appb-100019
    确定N个第四从向量
    Figure PCTCN2021122158-appb-100020
    每个第四从向量根据为该第一位置点选择的目标铆点对中的任两个铆点对的从坐标点得到,且该N个第四从向量可唯一表示该从坐标系;
    根据第三从向量
    Figure PCTCN2021122158-appb-100021
    和该N个第四从向量
    Figure PCTCN2021122158-appb-100022
    确定N个系数γ 1、γ 2、……、γ N,该N个系数满足
    Figure PCTCN2021122158-appb-100023
    根据该N个系数γ 1、γ 2、……、γ N和所述第二铆点对中的基坐标点,确定该第一位置点对应的在 基坐标系下的第二位置点,该第二位置点与所述第二铆点对中的基坐标点形成的第三基向量
    Figure PCTCN2021122158-appb-100024
    满足
    Figure PCTCN2021122158-appb-100025
    其中
    Figure PCTCN2021122158-appb-100026
    分别是
    Figure PCTCN2021122158-appb-100027
    对应的在基坐标系下的第四基向量;
    根据该从坐标系与基坐标系之间的方位角偏差,以及第一位置点的方位角,确定第二位置点的方位角,所述方位角偏差是根据所述铆点对集合确定的。
  14. 根据权利要求13所述的方法,其中,所述方位角偏差采用如下步骤确定:
    从所述铆点对集合中,选择从坐标点之间的距离最远的两个铆点对,或者,从所述铆点对集合中随机选择两个铆点对;
    确定由该两个铆点对中的两个从坐标点形成的从向量和由该两个从坐标点对应的在基坐标系下的两个基坐标点形成的基向量之间的方位角偏差;
    将该方位角偏差确定为该从坐标系与基坐标系之间的方位角偏差。
  15. 一种用于多机器人混行的装置,应用于调度平台,该装置包括:处理器、以及与所述处理器通过总线相连的非瞬时计算机可读存储介质;
    所述非瞬时计算机可读存储介质,存储有可被所述处理器执行的一个或多个计算机程序;所述处理器执行所述一个或多个计算机程序时实现以下步骤:
    确定机器人在基坐标系下的第一行驶路径信息;
    确定所述机器人自主定位所采用的从坐标系;
    利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在该从坐标系下的第二行驶路径信息;
    将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
  16. 一种用于多机器人混行的装置,应用于机器人,该装置包括:处理器、以及与所述处理器通过总线相连的非瞬时计算机可读存储介质;
    所述非瞬时计算机可读存储介质,存储有可被所述处理器执行的一个或多个计算机程序;所述处理器执行所述一个或多个计算机程序时实现以下步骤:
    接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息;
    确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息;
    利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息;
    根据第三行驶路径信息和第二位置信息自主行驶。
  17. 一种用于多机器人混行的装置,应用于调度平台,该装置包括:
    第一确定单元,用于确定机器人在基坐标系下的第一行驶路径信息;
    第二确定单元,用于确定所述机器人自主定位所采用的从坐标系;
    第三确定单元,用于利用预先配置的基坐标系与该从坐标系之间的铆点对集合,确定第一行驶路径信息对应的在该从坐标系下的第二行驶路径信息;
    发送单元,用于将第二行驶路径信息发送给所述机器人,以使所述机器人根据第二行驶路径信息行驶。
  18. 一种用于多机器人混行的装置,应用于机器人,该装置包括:
    接收单元,用于接收调度平台发送的所述机器人在基坐标系下的第三行驶路径信息;
    第四确定单元,用于确定所述机器人当前在所述机器人自主定位所采用的从坐标系下的第一位置信息;
    第五确定单元,用于利用预先配置的该从坐标系与基坐标系之间的铆点对集合,确定第一位置信息对应的在基坐标系下的第二位置信息;
    行驶单元,用于根据第三行驶路径信息和第二位置信息自主行驶。
  19. 一种非瞬时计算机可读存储介质,所述非瞬时计算机可读存储介质存储指令,所述指令在由处理器执行时使得所述处理器执行如权利要求1至8中任一权项所述的用于多机器人混行的方法中的步骤,或执行如权利要求9至14中任一权项所述的用于多机器人混行的方法中的步骤。
  20. 一种计算机程序,所述计算机程序在由处理器执行时使得所述处理器执行如权利要求1至8中任一权项所述的用于多机器人混行的方法中的步骤,或执行如权利要求9至14中任一权项所述的用于多机器人混行的方法中的步骤。
PCT/CN2021/122158 2020-09-30 2021-09-30 用于多机器人混行的方法、装置及存储介质 WO2022068926A1 (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202011060522.2A CN112162559B (zh) 2020-09-30 2020-09-30 用于多机器人混行的方法、装置及存储介质
CN202011060522.2 2020-09-30

Publications (1)

Publication Number Publication Date
WO2022068926A1 true WO2022068926A1 (zh) 2022-04-07

Family

ID=73861609

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/122158 WO2022068926A1 (zh) 2020-09-30 2021-09-30 用于多机器人混行的方法、装置及存储介质

Country Status (2)

Country Link
CN (1) CN112162559B (zh)
WO (1) WO2022068926A1 (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112162559B (zh) * 2020-09-30 2021-10-15 杭州海康机器人技术有限公司 用于多机器人混行的方法、装置及存储介质
CN113625714B (zh) * 2021-08-11 2024-03-15 重庆大学 一种基于并行求解的自动驾驶运动规划方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009157430A (ja) * 2007-12-25 2009-07-16 Toyota Motor Corp 座標補正方法、座標補正プログラム、及び自律移動ロボット
CN108534789A (zh) * 2017-12-27 2018-09-14 达闼科技(北京)有限公司 一种多路径定位坐标统一方法、电子设备和可读存储介质
CN110757454A (zh) * 2019-10-12 2020-02-07 广州中国科学院先进技术研究所 一种双机器人协同旋转的路径规划方法和装置
CN110794826A (zh) * 2019-09-24 2020-02-14 北京旷视机器人技术有限公司 混合导航方法及装置、通信方法及装置、设备、存储介质
CN111055287A (zh) * 2020-01-13 2020-04-24 广州启帆工业机器人有限公司 一种双机器人协作同步的方法、***、装置和存储介质
CN112162559A (zh) * 2020-09-30 2021-01-01 杭州海康机器人技术有限公司 用于多机器人混行的方法、装置及存储介质

Family Cites Families (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8718837B2 (en) * 2011-01-28 2014-05-06 Intouch Technologies Interfacing with a mobile telepresence robot
CN102581849B (zh) * 2012-01-05 2014-08-06 东南大学 一种基于nc代码的工业机器人轨迹规划方法
CN106909149B (zh) * 2017-03-14 2020-09-22 深圳蓝因机器人科技有限公司 一种深度摄像头避障的方法及装置
CN107727026A (zh) * 2017-10-18 2018-02-23 北方工业大学 面向双工业机器人协同工作的工件坐标系的标定方法
CN110377015B (zh) * 2018-04-13 2021-04-27 北京三快在线科技有限公司 机器人定位方法和机器人定位装置
CN109062416B (zh) * 2018-08-29 2021-11-02 广州视源电子科技股份有限公司 地图的状态转换方法和装置
CN110887483A (zh) * 2018-09-07 2020-03-17 深圳市优必选科技有限公司 机器人及导航方法、存储装置
CN109753510B (zh) * 2019-01-11 2023-04-14 深圳市网心科技有限公司 一种目标数据的获取方法、***、电子设备及存储介质
CN111457923B (zh) * 2019-01-22 2022-08-12 北京京东乾石科技有限公司 路径规划方法、装置及存储介质
CN109938842B (zh) * 2019-04-18 2021-07-30 雅客智慧(北京)科技有限公司 面部外科手术定位导航方法及装置
CN110268225B (zh) * 2019-05-09 2022-05-10 深圳阿科伯特机器人有限公司 一种多设备之间协同操作的方法、服务端及电子设备
CN110682289B (zh) * 2019-10-08 2021-01-12 华中科技大学 基于工业机器人的曲面工件坐标系自动标定方法
CN111275730A (zh) * 2020-01-13 2020-06-12 平安国际智慧城市科技股份有限公司 地图区域的确定方法、装置、设备及存储介质
CN110928320B (zh) * 2020-02-10 2020-08-04 上海高仙自动化科技发展有限公司 路径生成方法及生成装置、智能机器人及存储介质
CN111467799B (zh) * 2020-04-22 2023-04-07 网易(杭州)网络有限公司 一种坐标转换方法、装置、电子设备和存储介质
CN111583136B (zh) * 2020-04-25 2023-05-23 华南理工大学 一种救援场景下自主移动平台同时定位与建图方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009157430A (ja) * 2007-12-25 2009-07-16 Toyota Motor Corp 座標補正方法、座標補正プログラム、及び自律移動ロボット
CN108534789A (zh) * 2017-12-27 2018-09-14 达闼科技(北京)有限公司 一种多路径定位坐标统一方法、电子设备和可读存储介质
CN110794826A (zh) * 2019-09-24 2020-02-14 北京旷视机器人技术有限公司 混合导航方法及装置、通信方法及装置、设备、存储介质
CN110757454A (zh) * 2019-10-12 2020-02-07 广州中国科学院先进技术研究所 一种双机器人协同旋转的路径规划方法和装置
CN111055287A (zh) * 2020-01-13 2020-04-24 广州启帆工业机器人有限公司 一种双机器人协作同步的方法、***、装置和存储介质
CN112162559A (zh) * 2020-09-30 2021-01-01 杭州海康机器人技术有限公司 用于多机器人混行的方法、装置及存储介质

Also Published As

Publication number Publication date
CN112162559A (zh) 2021-01-01
CN112162559B (zh) 2021-10-15

Similar Documents

Publication Publication Date Title
WO2022068926A1 (zh) 用于多机器人混行的方法、装置及存储介质
CN109764877B (zh) 一种机器人跨楼层导航方法、装置及机器人
US10694319B2 (en) Network device based proximity beacon locating
CN105264335B (zh) 机器人装置的离机式导航方法与设备
EP2835230A2 (en) Robot control apparatus and method for controlling robot
WO2017165383A1 (en) Systems and methods for autonomous drone navigation
WO2021027967A1 (zh) 一种路线确定方法、可行进设备、和存储介质
US11040448B2 (en) Methods and systems for establishing and maintaining a pre-build relationship
WO2020215711A1 (zh) 一种基站位置坐标的确定方法、装置、设备及存储介质
US11648674B2 (en) System and method for robotic bin picking using advanced scanning techniques
KR20220136300A (ko) 레이저 레이더와 위치 결정 기기의 캘리브레이션 방법, 기기 및 자율 주행 차량
US8671415B2 (en) Persisting application state
CN112285739B (zh) 一种数据处理方法、装置、设备及存储介质
CN110379044A (zh) 一种运动误差补偿的方法和装置
CN109933058B (zh) 用于确定可移动设备的移动误差的方法、装置、服务器及存储介质
CN109859156B (zh) 异常帧数据的处理方法及装置
CN113132952A (zh) 一种基于机器人的网络质量确定方法、装置、设备及介质
WO2022198992A1 (zh) 一种机械臂运动规划方法、装置、可读存储介质及机械臂
KR20230073093A (ko) 정보 처리 시스템, 정보 처리 방법 및 정보 처리 프로그램을 격납한 기록 매체
CN112925302A (zh) 机器人位姿控制方法和装置
CN113761091B (zh) 闭环检测方法、装置、电子设备、***和存储介质
Huang et al. Multi-objective trajectory optimization of the 2-redundancy planar feeding manipulator based on pseudo-attractor and radial basis function neural network
CN107511829B (zh) 机械手的控制方法及装置、可读存储介质及自动化设备
CN110375752B (zh) 一种生成导航点的方法和装置
CN112180910A (zh) 一种移动机器人障碍物感知方法和装置

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21874580

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21874580

Country of ref document: EP

Kind code of ref document: A1