阅读说明：本技术 一种自动归位椅复合路径规划方法 (Automatic homing chair composite path planning method ) 是由 倪良正 张叙俊 朱志华 黎启坤 谢淑辉 胡芳园 于 2019-09-26 设计创作，主要内容包括：本发明属于自动归位椅领域,具体涉及一种自动归位椅复合路径规划方法,包括：步骤1)上位机向下发送一组站点数据；步骤2)接收器收到站点后,对站点进行分类,遍历所有站点；步骤3)直线生成器接受到一个站点时,计算其与上一个站点的方向角和距离；步骤4.1)曲线生成器接受到一个站点时,根据该站点以及与该站点邻近的上下站点的关系计算出该站点转弯时的圆弧及该圆弧的弧度,然后调用直线生成器生成上一站点到转弯起点的直线点；步骤4.2)利用曲线生成器生成转弯起点到转弯终点的圆弧点。本发明将曲线模式与直线模式相结合,在保证安全性的情况下,部分站点采用曲线模式,使运输更加合理、高效。(The invention belongs to the field of automatic homing chairs, and particularly relates to a composite path planning method for an automatic homing chair, which comprises the following steps: step 1), an upper computer sends a group of site data downwards; step 2) after the receiver receives the sites, classifying the sites and traversing all the sites; step 3), when the linear generator receives a station, calculating the direction angle and the distance between the linear generator and the previous station; step 4.1) when the curve generator receives a station, calculating an arc and the radian of the arc when the station turns according to the station and the relation between the station and an upper station and a lower station adjacent to the station, and then calling the straight line generator to generate a straight line point from the previous station to a turning starting point; and 4.2) generating arc points from the turning starting point to the turning ending point by using the curve generator. The invention combines the curve mode and the straight line mode, and partial stations adopt the curve mode under the condition of ensuring the safety, so that the transportation is more reasonable and efficient.)

1. A composite path planning method for an automatic homing chair is characterized by comprising the following steps:

step 1) an upper computer sends a group of station data downwards, wherein the station data comprises station poses, straight bends/arc bends, turning radii and advancing/retreating of the station;

step 2) after the receiver receives the stations, classifying the stations according to straight bending/arc bending, traversing all the stations, and respectively issuing the stations to the straight line generator and the curve generator;

step 3) when the straight line generator receives a station, calculating the direction angle and the distance between the straight line generator and the previous station, then judging the type of the previous station, and if the straight line generator is in a straight bending state, the distance is the straight line distance from the station to the previous station; if the straight line path is curved, subtracting the length of the previous path from the straight line distance from the station to the previous station, and performing secondary linear interpolation by using the obtained direction angle and distance to generate a straight line path;

step 4.1) when the curve generator receives a station, calculating an arc and the radian of the arc when the station turns according to the station and the relation between the station and an upper station and a lower station adjacent to the station, calculating the distance from the previous station to a turning starting point according to a central angle, and calling the straight line generator to generate a straight line point from the previous station to the turning starting point;

step 4.2) generating arc points from the turning starting point to the turning end point by using a curve generator;

and 4.3) calling the straight line generator to generate a straight line point from the turning end point to the next station.

2. The method for planning the composite path of the automatic homing chair according to claim 1, wherein in the step 4.1), before the straight line generator is called to generate the straight line point from the previous station to the turning starting point, the type of the previous station is judged to be straight bending or arc bending, and if the straight bending is carried out, the distance from the previous station to the turning starting point is the straight line distance from the previous station to the turning starting point; and if the curve is curved, the distance from the previous station to the turning starting point is the straight distance from the previous station to the turning starting point minus the length of the previous path.

3. The method for planning the composite path of the automatic homing chair according to claim 1, wherein in the step 4.2), when the curve generator is used for generating the arc points from the turning start point to the turning end point, the direction of the arc is firstly judged, the angular resolution is calculated, and finally, the radian of the arc, the direction of the arc, the diameter of the arc and the angular resolution are transmitted into the curve generator, so as to generate the corresponding arc points.

Technical Field

The invention belongs to the field of automatic homing chairs, and particularly relates to a composite path planning method for an automatic homing chair.

Background

An automatically guided stool or chair, called an automatic homing chair for short, has become an increasingly interesting part in modern commercial progress and life. In the field of existing commercial automatic homing chairs, path planning is generally divided into two modes according to a straight curve or an arc curve at a turning point: (1) straight line mode, (2) curved line mode. In the straight mode, all paths are made of straight lines, and the turning points are straight turns with given included angles. Such a path can ensure the safety of the automatic returning chair during the operation, but the automatic returning chair goes through a series of processes of deceleration, stop, autorotation, acceleration and the like at each turning point, which causes the reduction of the transportation efficiency. Under the curve mode, the automatic chair that resets of turning point department can directly cross the turn along the arc, has improved conveying efficiency, nevertheless needs sufficient space to guarantee the security. It is assumed that in a task path, a bend with a large turning space can be bent by an arc angle to improve efficiency, the turning space is small, and in order to ensure safety, a straight bend is proposed to be used. For this case, at present, only path splicing can be used. Accordingly, there is a need for improvement in the art.

The existing path planning method has the following problems:

one, the existing technology mode is single, and the two modes can not coexist.

Secondly, the existing straight bending mode has low efficiency.

Disclosure of Invention

In order to make up for the defects of the prior art, the invention provides a technical scheme of a composite path planning method for an automatic homing chair.

The method for planning the composite path of the automatic homing chair is characterized by comprising the following steps of:

step 1) an upper computer sends a group of station data downwards, wherein the station data comprises station poses, straight bends/arc bends, turning radii and advancing/retreating of the station;

step 2) after the receiver receives the stations, classifying the stations according to straight bending/arc bending, traversing all the stations, and respectively issuing the stations to the straight line generator and the curve generator;

step 3) when the straight line generator receives a station, calculating the direction angle and the distance between the straight line generator and the previous station, then judging the type of the previous station, and if the straight line generator is in a straight bending state, the distance is the straight line distance from the station to the previous station; if the straight line path is curved, subtracting the length of the previous path from the straight line distance from the station to the previous station, and performing secondary linear interpolation by using the obtained direction angle and distance to generate a straight line path;

step 4.1) when the curve generator receives a station, calculating an arc and the radian of the arc when the station turns according to the station and the relation between the station and an upper station and a lower station adjacent to the station, calculating the distance from the previous station to a turning starting point according to a central angle, and calling the straight line generator to generate a straight line point from the previous station to the turning starting point;

step 4.2) generating arc points from the turning starting point to the turning end point by using a curve generator;

and 4.3) calling the straight line generator to generate a straight line point from the turning end point to the next station.

The method for planning the composite path of the automatic homing chair is characterized in that in the step 4.1), the type of the previous station is judged to be straight bending or arc bending before the straight line generator is called to generate the straight line point from the previous station to the turning starting point, and if the straight bending is carried out, the distance from the previous station to the turning starting point is the straight line distance from the previous station to the turning starting point; and if the curve is curved, the distance from the previous station to the turning starting point is the straight distance from the previous station to the turning starting point minus the length of the previous path.

The method for planning the composite path of the automatic homing chair is characterized in that in the step 4.2), when the curve generator is used for generating arc points from a turning starting point to a turning ending point, the direction of the arc is judged firstly, the angular resolution is calculated, and finally the radian of the arc, the direction of the arc, the diameter of the arc and the angular resolution are transmitted into the curve generator so as to generate corresponding arc points.

The invention has the beneficial effects that: the invention combines the curve mode and the straight line mode, and partial stations adopt the curve mode under the condition of ensuring the safety, so that the transportation is more reasonable and efficient.

Drawings

FIG. 1 is a flow chart of the present invention;

FIG. 2 is a schematic diagram of a curve generator generation path of the present invention;

fig. 3 is a schematic diagram of the composite path planning of the present invention.

Detailed Description

The invention will be further explained with reference to the drawings.

As shown in fig. 1, a method for planning a composite path of an automatic homing chair includes:

step 1) the upper computer sends a group of station data downwards, wherein the station data comprises station position and posture, Straight bend/arc bend, turning radius and Forward/Backward of the station, such as { [ (x, y, theta), Straight,0.0, Forward ], [ (x, y, theta), Curve,1.0, Forward ], [ (x, y, theta), Curve,0.6, Backward ] };

step 2) after receiving the stations, the receiver classifies the stations, calculates the straight bending point to be num _ s and the arc bending point to be num _ c, traverses all the stations and respectively sends the stations to a straight line generator and a curve generator;

and 3) if the straight line generator receives a station, calculating the direction angle ori and the distance dist of the station from the previous station (if the point is the first point, the previous point is the initial position of the automatic homing chair). Then, the type of the last point is judged, if the last point is straight-curved, the distance is dist ═ dist_{Straight line}(ii) a If the arc is curved, the distance is dist ═ dist_{Straight line}Dist _ previous, where dist_{Straight line}Dist _ previous is the length of the last path, which is the straight-line distance from the station to the last station. Performing secondary linear interpolation by using the ori and dist to generate a straight-line segment path;

step 4.1) when the curve generator receives a station, calculating an arc and the radian of the arc when the station turns according to the station and the relation between the station and an upper station and a lower station adjacent to the station, calculating the distance from the previous station to a turning starting point according to a central angle, and calling the straight line generator to generate a straight line point from the previous station to the turning starting point;

step 4.2) generating arc points from the turning starting point to the turning end point by using a curve generator;

step 4.3) calling a straight line generator to generate a straight line point from the turning end point to the next station;

in the step 4.1), before the straight line generator is called to generate a straight line point from the previous station to the turning starting point, whether the type of the previous station is straight bending or arc bending is judged, and if the type of the previous station is straight bending, the distance from the previous station to the turning starting point is the straight line distance from the previous station to the turning starting point; and if the curve is curved, the distance from the previous station to the turning starting point is the straight distance from the previous station to the turning starting point minus the length of the previous path.

In step 4.2), when the curve generator is used to generate arc points from the turning start point to the turning end point, the direction of the arc is judged first, the angular resolution is calculated, and finally the radian of the arc, the direction of the arc, the diameter of the arc and the angular resolution are transmitted into the curve generator, so that the corresponding arc points are generated.

Step 4) is described below with reference to specific examples:

as shown in fig. 2, the Curve generator receives a station b, and the attribute of the station b is { (5.0,5.0,0.0), currve, 1.0, Forward }, a is the previous station, e is the turning start point, d is the turning end point, c is the next station, the included angle α is calculated by formula (1),

where A is the distance between stations a and B, B is the distance between stations B and C, and C is the distance between stations a and C. Thus, the central angle β ═ pi- α. Calculating the length of eb by the formula (2),

wherein the turning radius r is 1.0 m. Thus ae is l in length_ae＝A-l_eb。

And (4.1) calculating the direction angle of the ae segments according to the distance of the ae segments, and calling a straight line generator to generate straight line points of the ae segments. Of course, it is first determined whether the last point is curved or straight, and if so, the distance l is transmitted into the straight line generator_ae-l_previousWherein l is_previousIs the length of the previous segment of the path.

(4.2) Cross-multiplication of the two vectors

To determine the direction sign of the arc. Calculating the angular resolution as

Wherein res_globalThe waypoint resolution set in advance is generally set to 0.05 m. And finally, transmitting the beta, sign, r and res into a curve generator to generate corresponding arc points.

Finally, the current l_ebIs stored as a length of_previousWhere the distance from point b to point d is equal to l_ebEquality, this is equivalent to saving the distance from point b to point d as l_previous。

The schematic path planned by the final composite path is shown in fig. 3.

The curve generator and the straight line generator are known in the art.

Finally, it should be noted that: the above embodiments are only used to illustrate the technical solution of the present invention, and not to limit the same; while the invention has been described in detail and with reference to the foregoing embodiments, it will be understood by those skilled in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some or all of the technical features may be equivalently replaced; and the modifications or the substitutions do not make the essence of the corresponding technical solutions depart from the scope of the technical solutions of the embodiments of the present invention.