1843 results about "Trajectory planning" patented technology

A temporal controller for mobile robot path planning includes a sensor module for receiving data corresponding to spatial locations of at least one object, and a temporal control module operatively coupled to the sensor module, the temporal control module configured to predict future locations of the at least one object based on data received by the sensor module. The controller further includes a temporal simulation module operatively coupled to the temporal control module, wherein the temporal simulation module configured to use the predicted future locations of the at least one object to simulate multiple robot motion hypothesis for object avoidance and trajectory planning.

The invention discloses a dynamic automatic drive lane-changing trajectory planning method based on real-time environment information. A rollover limitation trajectory vertical coordinate, an optimal trajectory and a collision avoidance trajectory terminus security area are calculated; the relation between the rollover limitation trajectory vertical coordinate and the security area is compared, the positional relation between the optimal trajectory vertical coordinate and the security area is further compared, and then lane-changing decision-making is conducted. According to the dynamic automatic drive lane-changing trajectory planning method based on the real-time environment information, and a polynomial trajectory equation which dose not depend on time is adopted to represent a lane-changing trajectory curve, so that the problem that hypotheses of a speed and an accelerated speed are too strong is avoided; furthermore, collision avoidance algorithm and rollover prevention algorithm which are based on reaction time are introduced to guarantee security of lane-changing; then the optimal trajectory in a safe trajectory cluster is determined through real-time speed adjusting; and finally, an optimal lane-changing trajectory of real-time dynamic state is output through a trajectory generation module to guide an autonomous vehicle to complete a lane-changing behavior, and therefore a set of complete dynamic autonomous vehicle lane-changing trajectory planning module is built.

A system for providing the reliable and numerically efficient generation of time-optimum trajectories with easy-to-track or continuous acceleration profiles for simple and blended moves of single- and multi-arm robotic manipulators, such as an extension and retraction move along a straight line or a rotary move following a circular arc, with velocity, acceleration, jerk, and jerk rate constraints. A time-optimum trajectory is the set of the position, velocity, and acceleration profiles which describe the move of a selected end effector along a given path in the shortest time possible without violating given constraints, with a special case being an optimum abort trajectory, which brings the moving arm into complete rest in the shortest time. The invention involves firstly identifying the set of fundamental trajectory shapes which cover all possible combinations of constraints for a given category of moves, e.g., a move along a straight line or along a circular arc; next, decomposing the fundamental shapes into segments where a single constraint is active; and, then, determining the time optimum paths in the segments. As a result, a unique design of time-optimum trajectories is produced based on a set of pre-defined trajectory shapes. The invention also involves the blending of simple moves into a single trajectory by decomposing trajectories of the individual moves into their orthogonal components and overlapping them for a given time interval, which results in a non-stop move along a smooth transfer path.

The present invention provides a local trajectory planning method and apparatus for a smart vehicle, pre-acquiring path planning information from a starting location to a destination; the method comprising: determining a target lane; sampling alternative curves from a current location of the smart vehicle to a target lane according to the path planning information; performing speed planning for the sampled alternative curves according to a current travel environment; selecting one of the alternative curves after the speed planning is performed as a target trajectory. Local trajectory planning of the smart vehicle is achieved through the present invention.

Crane control and anti-sway are facilitated utilizing a diagnostic component that includes a model component and a control component. The diagnostic component interfaces with an extrinsic data analysis component and a controller component. The diagnostic component receives operating condition information from the extrinsic data analysis component and performs predictive modeling, based on a current status and stored information. Further, the diagnostic component predicts the affect of the operating conditions on a crane and implements and / or recommends actions to mitigate the affect of the existing and / or predicted operating conditions. The diagnostic component further mitigates crane sway and / or induces crane sway to reduce container transit time. Intelligent agents are employed to provide trajectory planning and execution and / or to detect potential component failure.

A trailer backup assist system, according to one embodiment, includes a state estimator that determines a current position of a trailer relative to a plurality of waypoints. A trajectory planner may then incrementally generate a path from the current position to the plurality of waypoints. The trajectory planner has a first mode that generates first and second circular trajectories tangent to one another connecting between the current position and a waypoint of the plurality of waypoints. A second mode of the trajectory planner generates the second circular trajectory between the current position and the waypoint after the trailer traverses the first circular trajectory. Also, a third mode of the trajectory planner switches to the first operating mode when the trailer reaches the waypoint for guidance to a subsequent waypoint. A curvature controller guides the trailer based on a curvature of the respective first or second circular trajectories.

A data-driven prediction-based system and method for trajectory planning of autonomous vehicles are disclosed. A particular embodiment includes: generating a first suggested trajectory for an autonomous vehicle; generating predicted resulting trajectories of proximate agents using a prediction module; scoring the first suggested trajectory based on the predicted resulting trajectories of the proximate agents; generating a second suggested trajectory for the autonomous vehicle and generating corresponding predicted resulting trajectories of proximate agents, if the score of the first suggested trajectory is below a minimum acceptable threshold; and outputting a suggested trajectory for the autonomous vehicle wherein the score corresponding to the suggested trajectory is at or above the minimum acceptable threshold.

The invention discloses a lane changing trajectory planning method for an unmanned vehicle based on vehicle-to-vehicle cooperation. In consideration of the vehicle lane changing complexity in an unmanned driving environment and characteristics of frequent turning and lane changing in urban road sections, a vehicle-to-vehicle cooperation policy and a trajectory planning method during the lane changing process are provided. With a lane changing cooperation policy and a quintic polynomial trajectory planning method as a basis and with vehicle kinematics and comfort as control conditions, a main vehicle lane changing trajectory optimization model under different cooperation degrees of a rear vehicle in the target lane is built; and besides, in consideration of defects of traditional elliptic and circular vehicle simulation models, through analyzing a boundary relationship between a possible collision point and a vehicle contour, a collision avoidance boundary condition under a rectangular vehicle model is built, and the vehicle lane changing trajectory model is tested through a scene. Under the vehicle-to-vehicle cooperation condition, safe vehicle lane changing under the unmanned driving environment can be completed, and requirements of lane changing comfort and kinematics can be met.

The invention discloses a method for manufacturing a five-axle linkage control three-dimensional printing device. The device is used for realizing an ink printing function on the surface of any three dimensional entity. The device mainly comprises a control system, a mechanical motion structure and a printing system, wherein the control system is based on five-axle linkage for motion control, which realizes motion control and printing control synchronously and the functions of three-dimensional computer-aided design and computer-aided process, and also realizes the functions of five-axle linkage motion trajectory planning and synchronous color resolution required by three-dimensional printing; the mechanical motion structure adopts a five-axle linkage mechanical structure, which realizes the functions of linkage of three linear motions and two rotary motions; and the printing system adopts four spray nozzles with independent telescopic function, which partly realizes the CMYK (Cyan, Magenta, Yellow and Black) four-color ink printing function.

The invention provides a composite three-dimensional point laser measurement system and a measurement method, comprising three-dimensional scanning and three-dimensional detection. Normal optical scanning is adopted so as to obtain the profile information of the article quickly and establish a three-dimensional model; motion trajectory planning is carried out by the profile data; and a point laser probe is guided to carry out more precise measurement so as to obtain the three-dimensional point cloud data of higher precision and higher quality. The three-dimensional non-contact detection to the characteristic position, appointed section line and integer of the workpiece is obtained further on the basis of comparing the point cloud and model data. The system and the method have the advantages that the non-contact measurement can obtain the point cloud of good quality and high precision, the article can be positioned freely, precise clamping devices are not needed, the measurement speed is quick, the process is automatic and the measured article has wide applicable range.

The invention provides an automatic spraying system based on point cloud and image matching. The automatic spraying system comprises a three-dimensional scanning module, an automatic trajectory planning module, a visual matching module and a spraying module. The three-dimensional scanning module is used for scanning a spraying object and acquiring a point cloud model according to scanned three-dimensional point cloud data; the automatic trajectory planning module is used for planning spraying trajectories in a point cloud space; the visual matching module is used for acquiring a transformational relation between a point cloud coordinate system and a spraying robot coordinate system; the spraying module is used for automatically spraying the spraying object. The automatic spraying system has the advantages that an algorithm is planned automatically according to a robot spraying path of the point cloud coordinate system, the point cloud coordinate system is correlated with the robot coordinate system according to the cloud point and image matching algorithm, and accordingly, automatic spraying of the spraying object is realized; on the basis of guaranteeing spraying efficiency, the spraying quality is improved greatly, calculation quantity for trajectory planning is reduced, and trajectory planning quality is improved.

A prediction-based system and method for trajectory planning of autonomous vehicles are disclosed. A particular embodiment is configured to: receive training data and ground truth data from a training data collection system, the training data including perception data and context data corresponding to human driving behaviors; perform a training phase for training a trajectory prediction module using the training data; receive perception data associated with a host vehicle; and perform an operational phase for extracting host vehicle feature data and proximate vehicle context data from the perception data, using the trained trajectory prediction module to generate predicted trajectories for each of one or more proximate vehicles near the host vehicle, generating a proposed trajectory for the host vehicle, determining if the proposed trajectory for the host vehicle will conflict with any of the predicted trajectories of the proximate vehicles, and modifying the proposed trajectory for the host vehicle until conflicts are eliminated.

The parallel kinematic machine (PKM) trajectory planning method is operable via a data-driven neuro-fuzzy multistage-based system. Offline planning based on robot kinematic and dynamic models, including actuators, is performed to generate a large dataset of trajectories, covering most of the robot workspace and minimizing time and energy, while avoiding singularities and limits on joint angles, rates, accelerations and torques. The method implements an augmented Lagrangian solver on a decoupled form of the PKM dynamics in order to solve the resulting non-linear constrained optimal control problem. Using outcomes of the offline-planning, the data-driven neuro-fuzzy inference system is built to learn, capture to and optimize the desired dynamic behavior of the PKM. The optimized system is used to achieve near-optimal online planning with a reasonable time complexity. The effectiveness of the method is illustrated through a set of simulation experiments proving the technique on a 2-degrees of freedom planar PKM.

A prediction-based system and method for trajectory planning of autonomous vehicles are disclosed. A particular embodiment is configured to: receive training data and ground truth data from a training data collection system, the training data including perception data and context data corresponding to human driving behaviors; perform a training phase for training a trajectory prediction module using the training data; receive perception data associated with a host vehicle; and perform an operational phase for extracting host vehicle feature data and proximate vehicle context data from the perception data, generating a proposed trajectory for the host vehicle, using the trained trajectory prediction module to generate predicted trajectories for each of one or more proximate vehicles near the host vehicle based on the proposed host vehicle trajectory, determining if the proposed trajectory for the host vehicle will conflict with any of the predicted trajectories of the proximate vehicles, and modifying the proposed trajectory for the host vehicle until conflicts are eliminated.

The invention discloses a robot cartesian space trajectory planning method. The method includes establishing a connecting rod coordinate system and obtaining a forward kinematic equation through a kinetic modeling analysis method; solving the rotating angles of a master control joint and a middle joint according to the vector geometric property and trajectory planning requirement of the robot; seeking a relation equation including introduced variables and solving the rotating angle of the corresponding joint by means of the kinetic modeling analysis method and the solved joint rotating angle; determining whether the pose position can be reached through a vector geometric method when the trajectory planning is carried out in a task space with obstacles; and planning the continuous time variant attitudes of coupled position information to complete the planning tasks. According to the method, extraneous roots can be prevented, efficient solutions can be screened and matched, strange paths can be effectively avoided, and meanwhile, the defects of complex end trajectory planned by the joint space can be prevented and optimized.

The invention provides a trajectory planning method, system and equipment and a storage medium. The method includes the following steps of: analyzing environmental information corresponding to the environment where a vehicle is located, and obtaining a driving scene where the vehicle is located; according to the driving scene where the vehicle is located, correspondingly selecting a trajectory planning mode with performance priority or efficiency priority as a target trajectory planning mode; according to the target trajectory planning mode, determining a path from the starting position of thevehicle to a target position, and determining a speed curve from the starting position of the vehicle to the target position; and combining the determined path and speed curve to obtain a trajectoryused by the vehicle from the starting position to the target position. The scheme of the invention can be adapted to planning the trajectory of automatic driving of the vehicle in different driving scenes.

The present invention provides an intersection condition-orientated unmanned vehicle trajectory planning method based on the Bezier curve and the VFH algorithm. The method includes the following steps that: 1) the starting point pose P0 (x0,y0,theta0) and destination point pose P3 (x3,y3,theta3) of current trajectory planning are acquired; 2) a trajectory cluster A1 from the starting point pose P0 (x0,y0,theta0) to the destination point pose P3 (x3,y3,theta3) is generated through adopting a three-order Bezier curve model; 3) the trajectory cluster A1 is screened according to a maximum curvature constraint, so that a trajectory cluster A2 is obtained, collision detection is performed on A2, so that a collision-free trajectory cluster A3 is obtained; 4) if A3 is not empty, an optimal trajectory is selected from A3 according to a trajectory smoothest principle and is outputted to a control layer, and the method is terminated, otherwise, the method shifts to step 5; 5) a movement region in the original VFH algorithm is improved, so that a fan-shaped movement region is built; 6) obstacle information is utilized to establish a grid map; 7) the fan-shaped movement region is divided into a plurality of fan-shaped regions, and whether an obstacle exists is judged; 8) the Bezier curve is used in combination, and optimal trajectory points are selected; and 9) with a discrete point set generated in the step 8 adopted as control points, a B-spline curve is generated, and the B-spline curve is adopted as the final trajectory of an unmanned vehicle.

The invention discloses a gait planning method for walking of a biped robot along a slope, and belongs to the technical field of robots. The method contains two core theories, namely, non-orthogonal decomposition and synthesis of a three-dimensional linear inverted pendulum and gait planning based on a biped long linear inverted pendulum. The method comprises the steps of gait parameter configuration, non-orthogonal decomposition of a three-dimensional linear inverted pendulum, foot trajectory planning based on three times of spline interpolation, centroid trajectory planning of a sagittal plane and a coronal plane based on a biped long linear inverted pendulum, non-orthogonal synthesis of the centroid trajectories of the sagittal plane and the coronal plane, and solving of joint trajectories of a robot based on inverse kinematics. By adopting the method of the invention, stable walking of a biped robot along all directions of a slope can be effectively achieved. The method is universal, simple in algorithm and high in practicality.

A vehicle control architecture designed based on a top-down approach with abstraction and modularity. The control architecture includes a vehicle / environment sensing and perception processor that processes sensor signals, and motion planning processors that provide lane center trajectory planning and tracking command, lane change trajectory planning and tracking command, and forward and backward speed and target tracking command. The architecture also includes a driver command interpreter that interprets driver commands and a command integration processor that provides reference dynamics for vehicle lateral, roll and longitudinal dynamics. The architecture also includes a control integration and supervisory controller that provides control integration and outputs integrated longitudinal force command signals, integrated lateral force command signals, integrated yaw moment command signals and steering torque command signals that are used by a vehicle longitudinal controller and a vehicle lateral controller.

Disclosed is a method for constructing a multi-mode environmental map in a three-dimensional environment. An unmanned vehicle is operated for many times in a mapping pattern, and different key frame coordinate sequences are obtained during each operation. Geographical proximity between different key frame coordinates is calculated on the basis of a Euclidean distance so as to identify cross joints of key frame sequences during different operations, these cross joints serve as nodes of a topological map, and multiple trajectories are connected together to form a whole map. By executing route planning based on a heuristic map search algorithm on the topological map, a route cross joint sequence can be obtained, original dense key frame coordinates can be obtained by indexing through the route cross joint sequence, and these coordinates serving as trajectory planning results are input to an unmanned vehicle control execution system, so as to realize position tracking of the unmanned vehicle.

The invention discloses a mobile robot automatic spraying device and a mobile robot automatic spraying control system and method. The mobile robot automatic spraying control system comprises a visualrecognition unit, a main control unit, a graphic reconstruction unit, a trajectory programming unit, a spraying unit and a robot control unit, wherein the visual recognition unit performs processing on collected image information of a workpiece to obtain geometric information; the graphic reconstruction unit performs optimization processing on the geometric information of the workpiece to obtain agridding three-dimensional model of the workpiece; the trajectory programming unit automatically recognizes a spraying area and calculates a spraying trajectory strategy to obtain a spraying trajectory file; the spraying unit plans a spraying path according to a positional relation between the workpiece of a robot and the spraying trajectory file, and generates codes capable of being executed bythe robot; and the robot control unit controls the industrial robot to execute a spraying action according to the code file. According to the invention, a visual recognition based trajectory planningmethod is adopted, the spraying trajectory is automatically planned in allusion to a workpiece to be sprayed, the robot automatically completes the paint spraying work, the work flexibility is increased, and the programming workload is reduced.

The invention belongs to the field of intelligent transportation, and provides an automatic driving lane change trajectory planning method based on quadratic form planning and a neural network. The method provided by the invention comprises the steps of: obtaining driving information of a lane change vehicle and surrounding vehicles by using an information sensing module; providing, by a lateral deviation recommendation module, a lateral deviation value based on the vehicle driving information so as to determine starting point and ending point position information of the lane change vehicle; calculating, by a path planning module, a static lane change path in a plane coordinate system of the lane change vehicle by using the vehicle driving information and the lateral deviation as input; and finally, providing, by a trajectory planning module, a time varying change law of the lane change vehicle and the surrounding vehicles to complete the target of lane change process planning. By adopting the automatic driving lane change trajectory planning method provided by the invention, under the premise of ensuring the safety of the lane change vehicle, the movement trajectories of the lanechange vehicle and the surrounding vehicles are comprehensively considered, and fast solution is achieved by using the quadratic form planning to improve the speed and comfort of the lane change process, thereby satisfying the requirements of automatic driving for the lane change sub-task optimization solution fastness.

The invention discloses an automatic driving lane changing preparation and execution integrated trajectory planning method. The method comprises the following steps: establishing a motion trajectory model of a lane changing vehicle in a lane changing preparation process; introducing a cubic polynomial to establish a trajectory equation of the lane changing vehicle in a lane changing execution process; establishing a safe distance model and a safe speed model in the lane changing preparation and lane changing execution processes; and establishing an integrated trajectory optimization model, andoptimizing the time and the acceleration in the lane changing preparation and execution processes to obtain a most trajectory meeting safety, efficiency and comfort requirements. An integrated lane changing trajectory set is established according to the vehicle motion characteristics, a safe lane changing trajectory set meeting lane changing safety requirements is chosen by using safety constraints, and finally the trajectories are optimized by considering the lane changing comfort and efficiency to obtain the optimal integrated trajectory meeting safety, comfort and efficiency requirements.The optimal lane changing trajectory planned in the invention has a high service level, and ensures that passengers have high comfort experiences and high efficiency experiences.

The invention discloses a track teaching and planning method of a master-slave mode multi-robot cooperative system. The method comprises the steps of: classifying the cooperative movement of the multi-robot system into a coupling movement and a superposition movement according to the relative movement modes between the tail end poses of the cooperative robots, and deducing the constraint relation between the tail end poses of the robots according to the two relative movement modes; and determining the track teaching steps and teaching information of the multi-robot cooperation according to the constraint relation, and converting the cooperative movement tack planning problem of the multi-robot cooperative system into Cartesian space track planning problem of a plurality of single robots so as to finish the track teaching and planning task of the multi-robot cooperative system. The track teaching and planning method disclosed by the invention can be applied in multiple service processes meeting the movement constrain, for example, partial cooperative movement in complex assembly task, carrying of large-size workpiece and non-fixture welding process, and the like, so that the track teaching and planning method has an extensive application prospect.

In the control method for mobile parallel manipulators, kinematic singularity and redundancy are solved through joint limits avoidance and manipulability criteria. By taking the MPM self-motion into consideration due to its redundancy, the inverse kinematic is derived using a hybrid neuro-fuzzy system, such as NeFIK. The discrete augmented Lagrangian (AL) technique is used to solve the highly nonlinear constrained multi-objective optimal control problem. An adaptive neuro-fuzzy inference system (ANFIS)-based structure (based on the result of the AL solution) is used to solve the online trajectory planning of the MPM.

An intelligent control method for vertical recovery of carrier rockets based on deep reinforcement learning is disclosed. A method of autonomous intelligent control for carrier rockets is studied. Theinvention mainly studies how to realize attitude control and path planning for vertical recovery of carrier rockets by using intelligent control. For the aerospace industry, the autonomous intellectualization of spacecrafts is undoubtedly of great significance whether in the saving of labor cost or in the reduction of human errors. A carrier rocket vertical recovery simulation model is established, and a corresponding Markov decision-making process, including a state space, an action space, a state transition equation and a return function, is established. The mapping relationship between environment and agent behavior is fitted by using a neural network, and the neural network is trained so that a carrier rocket can be recovered autonomously and controllably by using the trained neural network. The project not only can provide technical support for the spacecraft orbit intelligent planning technology, but also can provide a simulation and verification platform for attack-defense confrontation between spacecrafts based on deep reinforcement learning.

The invention relates to a fast and complete automatic driving trajectory planning method. The method comprises the steps that 1) a basic path is planned; 2) collision detection is carried out on thebasic driving path, and step 3) is carried out; if collision does not exist, whether the basic driving path reaches a target point is determined; if so, step 4) is carried out; if not, step 3) is carried out; 3) after a sampling / search path planning method is used to acquire a smooth effective path, step 4) is carried out; 4) after a curvature extreme value corresponding to the path is acquired, segmentation velocity is planned to acquire a trajectory; and 5) collision detection is carried out on the trajectory in time domain and spatial domain; if collision exists, whether the distance between a vehicle and an obstacle is greater than 2 times the minimum braking distance; if so, velocity re-planning and returning to step 4) are carried out; if not, returning to step 1) is carried out; finally the path and velocity are combined to generate a trajectory and output the trajectory. Compared with the prior art, the method provided by the invention has the advantages of trajectory planninginstantaneity improvement, stability, reliability and the like.

The invention provides a motion trajectory planning method of mechanical arms of a humanoid robot for preventing collision. In the prior art, the collision problem is not solved fundamentally. The method adopts a joint space-based interpolation method to solve the collision problem between the mechanical arms and a table caused by motion trajectory generation of the mechanical arms, and mainly aims at operation of humanoid arms of the humanoid robot oriented to tabletops or objects similar to tabletops. The mechanical arm freedom degree includes three freedom degrees of the shoulder, two freedom degrees of the elbow and two freedom degrees of the wrist. The concrete implementation method comprises under the premise of ensuring completion of target operation at a fixed moment, properly bending the elbow at the collision occurring moment during the motion of the mechanical arms to prevent collision. With such scheme, the mechanical arms can move without collision while realizing high flexibility and large operation space.