Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JPH07104704B2 - Curve interpolation method in numerical control - Google Patents
[go: Go Back, main page]

JPH07104704B2 - Curve interpolation method in numerical control - Google Patents

Curve interpolation method in numerical control

Info

Publication number
JPH07104704B2
JPH07104704B2 JP61115612A JP11561286A JPH07104704B2 JP H07104704 B2 JPH07104704 B2 JP H07104704B2 JP 61115612 A JP61115612 A JP 61115612A JP 11561286 A JP11561286 A JP 11561286A JP H07104704 B2 JPH07104704 B2 JP H07104704B2
Authority
JP
Japan
Prior art keywords
point
curvature
interpolation method
points
vector
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Lifetime
Application number
JP61115612A
Other languages
Japanese (ja)
Other versions
JPS62271004A (en
Inventor
禎介 丸竹
世子 藤原
秀男 柴野
雅幸 宮崎
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
NEC Corp
Original Assignee
NEC Corp
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 NEC Corp filed Critical NEC Corp
Priority to JP61115612A priority Critical patent/JPH07104704B2/en
Publication of JPS62271004A publication Critical patent/JPS62271004A/en
Publication of JPH07104704B2 publication Critical patent/JPH07104704B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Landscapes

  • Numerical Control (AREA)

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明は数値制御における曲線補間方式に関し、特に、
2点P1とP2における位置のベクトル▲▼P2及び進行
方向のベクトルq1とq2が与えられたとき、2点間をなめ
らかな曲線で結ぶ数値制御における曲線補間方式に関す
る。
The present invention relates to a curve interpolation method in numerical control, and in particular,
The present invention relates to a curve interpolation method in a numerical control that connects two points with a smooth curve when given a position vector ▲ ▼ P 2 and traveling direction vectors q 1 and q 2 at two points P 1 and P 2 .

〔従来の技術〕[Conventional technology]

従来、この種の数値制御における補間方式は、簡単な関
数式、例えば直線,円,楕円,放物線等に基づいて曲線
上の座標点を計算する補間方式であった。
Conventionally, the interpolation method in this type of numerical control has been a simple function expression, for example, an interpolation method for calculating coordinate points on a curve based on a straight line, a circle, an ellipse, a parabola, or the like.

〔発明が解決しようとする問題点〕[Problems to be solved by the invention]

上述した従来の数値制御の補間方式では、簡単な関数に
従わない自由曲線を補間する場合、前記関数式に当ては
めるための複数な近似前処理計算を必要とする欠点があ
った。
The above-described conventional numerical control interpolation method has a drawback that when interpolating a free-form curve that does not follow a simple function, it requires a plurality of approximate pre-processing calculations for fitting to the functional expression.

〔問題点を解決するための手段〕[Means for solving problems]

上記問題点を解決するために、本発明の任意の2点P1
P2間をなめらかな曲線で結ぶ数値制御の曲線補間方式
は、点P1における位置ベクトルおよびその点での進行方
向ベクトルおよび点P2における位置ベクトルおよびその
点での進行方向ベクトルに基づき、点P1における曲率1/
R1および点P2における曲率1/R2を算出し、2点間の曲率
を、点P1と点P2とを円周上の点として含む円弧の曲率と
なるように予め定められた関数にしたがって曲率1/R1
ら曲率1/R2間で順次変化させ、複数の補間軌跡の座標値
を算出することを特徴としている。
In order to solve the above problems, two arbitrary points P 1 of the present invention
A numerical control curve interpolation method that connects P 2 with a smooth curve is based on the position vector at point P 1 and the traveling direction vector at that point and the position vector at point P 2 and the traveling direction vector at that point. Curvature at P 1 1 /
The curvature 1 / R 2 at R 1 and the point P 2 is calculated, and the curvature between the two points is predetermined so as to be the curvature of an arc including the points P 1 and P 2 as points on the circumference. The feature is that the coordinate values of a plurality of interpolation loci are calculated by sequentially changing from curvature 1 / R 1 to curvature 1 / R 2 according to a function.

〔実施例〕〔Example〕

次に本発明について図面を用いて説明する。第1図は本
発明の一実施例を示し、第2図は補間方式の原理を示す
図である。
Next, the present invention will be described with reference to the drawings. FIG. 1 shows an embodiment of the present invention, and FIG. 2 shows the principle of the interpolation method.

まず、第1図を用いて本発明の実施例を説明する。第1
図は本発明の一実施例のブロック図である。本発明では
入力装置100より入力されたデータP1,q1,θ1,P2
q2,θ2を補間器200を通して出力装置300へ補間軌跡上
の座標値(P(i)x,P(i)y)を出力する。
First, an embodiment of the present invention will be described with reference to FIG. First
The figure is a block diagram of one embodiment of the present invention. In the present invention, the data P 1 , q 1 , θ 1 , P 2 ,
Coordinate values (P (i) x , P (i) y ) on the interpolation locus are output to the output device 300 through q 2 and θ 2 through the interpolator 200.

なお、補間器200は、曲率を変化させる基準軸lをn等
分する線分分割器201と、lをn等分したi番目の点に
対する曲率1/R(i)を求める曲率演算器202と、この曲率
演算部202において求められた曲率1/R(i)よりlをn等
分したi番目の点に対する座標値(P(i)x,P(i)y)を求
める座標値算出器203とから構成されている。
The interpolator 200 includes a line segment divider 201 that divides a reference axis 1 that changes the curvature into n equal parts, and a curvature calculator 202 that obtains a curvature 1 / R (i) for the i-th point that divides l into equal parts. And a coordinate value calculation for obtaining a coordinate value (P (i) x , P (i) y ) for the i-th point obtained by equally dividing l from the curvature 1 / R (i) obtained by the curvature calculation unit 202 It is composed of a container 203.

次に、第2図を用いて本発明の補間方式について説明す
る。第2図(a)は点▲▼における位置のベクトル
▲▼とその点での進行方向ベクトル▲▼及び点
P2における位置のベクトル▲▼とその点での進行方
向ベクトル▲▼の関係を示す。以下、点P1での補間
軌跡の曲率1/R1と点P2での補間軌跡の曲率1/R2を求め、
点P1と点P2間の曲率を次第に変化させ、なめらかに2点
間の補間軌跡を決める方法について説明する。
Next, the interpolation method of the present invention will be described with reference to FIG. FIG. 2A shows a position vector ▲ ▼ at a point ▲ ▼ and a traveling direction vector ▲ ▼ and a point at that point.
The relationship between the position vector ▲ ▼ at P 2 and the traveling direction vector ▲ ▼ at that point is shown. Hereinafter, calculated curvature 1 / R 2 interpolation trajectory of curvature 1 / R 1 and point P 2 of the interpolation trajectory at point P 1,
A method of gradually changing the curvature between the points P 1 and P 2 and smoothly determining the interpolation locus between the two points will be described.

第2図(b)においてp1と点P2を通る円で▲▼に接
する円O1を示すがこの円O1の曲率を点P1での曲率1/R1
すると 但しθ1;▲▼P2(=▲▼−▲▼)と▲
▼の成す角となり|▲▼−▲▼|=lとおく
と式は 1/R1=2sinθ1/l ……… となる。同様にして、点P2での曲率1/R2は 1/R2=2sinθ2/l ……… 但し、θ2;▲▼P2と▲▼の成す角 となる。
If shows a circle O 1 in contact with the ▲ ▼ a circle passing through p 1 and point P 2 in FIG. 2 (b) and the curvature 1 / R 1 of curvature of the circle O 1 at the point P 1 However, θ 1 ; ▲ ▼ P 2 (= ▲ ▼-▲ ▼) and ▲
It becomes the angle formed by ▼, and if we set | ▲ ▼ − ▲ ▼ | = l, the formula becomes 1 / R 1 = 2sin θ 1 / l ………. Similarly, the curvature 1 / R 2 at point P 2 is 1 / R 2 = 2sinθ 2 / l ......... However, theta 2; ▲ ▼ the angle between the P 2 and ▲ ▼.

そこで点P1と点P2間での曲率の変化を一例として、SiN
カーブで変化させた場合について考える。
Therefore, as an example of the change in curvature between points P 1 and P 2 ,
Consider the case of changing the curve.

曲率を変化させる基準軸をl上に取ると、まず線分分割
器201においてlをn等分する。そして曲率演算器202に
おいて、lをn等分したi番目の点での曲率1/R(i)を求
めると となり(第2図(c)参照)式に,式を代入し整
理すると 曲率1/Rの変化に注目すると第2図(d)の様になり、 の点が存在するとき、その点は点P1と点P2間の補間軌跡
の変曲点となる。
When the reference axis for changing the curvature is set on l, first, the line segment divider 201 divides l into n equal parts. Then, in the curvature calculator 202, when the curvature 1 / R (i) at the i-th point obtained by dividing l into n is calculated, (See Figure 2 (c)) Focusing on the change in curvature 1 / R, it becomes as shown in Fig. 2 (d). When the point exists, the point becomes an inflection point of the interpolation locus between the points P 1 and P 2 .

lをn等分したi番目の点に対する補間軌跡上にある点
P(i)は座標値算出器203において、曲線演算器202で求め
られた曲率を用い以下に示す式に基づいて算出される。
ここで点P(i)は1上のi番目の点よりlに垂直に上げた
線上で、しかも点P1と点P2を通る曲率半径R(i)の円の上
にある点とする。(第2図(e)) また、点P1でこの円の接触と直線lの成す角をθi
し、直線lの傾きをとする。第2図(e)の半径R(i)
に対する円の中心座標(Ox,Oy)とすると円の方程式は (x−Ox2+(y−Oy2=R2(i) ……… この時Ox=P1x+R(i)sin(θi+) ……… Oy=P1y+R(i)cos(θi+) ……… 但し▲▼の座標値(P1x,P1y) (以降、他についても同様の表現をする) またl上のi番目の点を通りlに垂直な直線の式は Piの点を通るという条件より 但し (ここでP2x−P1x=P12x P2y−P1y=P12yとおく) さてここで、 cos(θi+)=cosθicos ……… −sinθisin sin(θi+)=sinθicos ……… +cosθisin また 式に式を代入しと〜式を使って整理すると (1+A2)x−2F+G=0 ……… 但し また、l=|▲▼P2| 式の2次方程式を解くと 但し、Dは式と同じ したがって求める点P(i)の座標は となる。
A point on the interpolation locus for the i-th point obtained by dividing l into n equal parts
P (i) is calculated by the coordinate value calculator 203 using the curvature obtained by the curve calculator 202 based on the following equation.
Here, the point P (i) is a point on the line perpendicular to the i-th point on 1 perpendicular to l, and on the circle of radius of curvature R (i) passing through the points P 1 and P 2. . (FIG. 2 (e)) Further, the angle between the contact of this circle and the straight line l at the point P 1 is θ i, and the inclination of the straight line l is. Radius R (i) in Fig. 2 (e )
Circle center coordinates for (O x, O y) to the equation of the circle (x-O x) 2 + (y-O y) 2 = R 2 (i) ......... when the O x = P 1x + R (i) sini +) ……… O y = P 1y + R (i) cosi +) ……… However, the coordinate value of ▲ ▼ (P 1x , P 1y ) The expression of a straight line passing through the i-th point on l and perpendicular to l is From the condition that it passes the point of P i However (Where P 2x -P 1x = P 12x P 2y -P 1y = P 12y and rear) Well Here, cos (θ i +) = cosθ i cos ......... -sinθ i sin sin (θ i +) = sin θ i cos ……… + cos θ i sin Substituting the expression into the expression and rearranging it using the expression (1 + A 2 ) x−2F + G = 0 ……… However Also, if you solve the quadratic equation of l = | ▲ ▼ P 2 | However, D is the same as the formula. Therefore, the coordinates of the point P (i) to be obtained are Becomes

以上の様にして、l上をn等分した各々の点を基準にし
て補間軌跡上の座標値を順次求めていく。つまり、iを
1からnまで変化させながら曲率演算器202と座標値算
出器203とを繰り返し実行させることにより、(P(i)x
P(i)y)のjを1からnまでの座標値を算出する。この
各座標を順に結ぶことによりなめらかな補間軌跡が求め
られる。(第2図(f)参照) なお本実施例では2次平面について述べてきたが、2次
平面に限るものではない。
As described above, the coordinate values on the interpolation locus are sequentially obtained on the basis of each point obtained by dividing n on n equally. That is, by repeatedly executing the curvature calculator 202 and the coordinate value calculator 203 while changing i from 1 to n, (P (i) x ,
The coordinate value of 1 to n is calculated for j of P (i) y ). A smooth interpolation locus can be obtained by connecting these coordinates in order. (See FIG. 2 (f)) Although the secondary plane has been described in this embodiment, the present invention is not limited to the secondary plane.

〔発明の効果〕〔The invention's effect〕

以上説明したように本発明は点P1における位置のベクト
ルP1とその点での進行方向のベクトル▲▼及び点P2
における位置のベクトル▲▼とその点での進行方向
のベクトル▲▼より点P1における曲線1/R1と点P2
おける曲率1/R2を求め2点間の曲率を点P1と点P2を円周
上の点として含む円弧の曲率となるように1/R1から1/R2
間で順次変化させ、複数の補間軌跡の座標値を算出し、
この各座標値を順に結ぶようにしたので、なめらかな曲
線を容易に補間できるという効果がある。
Above-described manner, the present invention is a vector P 1 position at the point P 1 traveling direction of the vector at that point ▲ ▼ and the point P 2
Position Vector ▲ ▼ and the point P 1 a curvature between curves 1 / R 1 and curvature at the point P 2 1 / R 2 look 2 points in the travel direction of the vector ▲ ▼ points P 1 than at that point a point in 1 / R 1 to 1 / R 2 so that the curvature of the arc includes P 2 as a point on the circumference
Change sequentially between the two, calculate the coordinate values of multiple interpolation loci,
Since the respective coordinate values are connected in order, there is an effect that a smooth curve can be easily interpolated.

【図面の簡単な説明】[Brief description of drawings]

第1図は本発明の一実施例を示す図である。第2図
(a)〜(f)は本発明の補間方式の原理を説明するた
めの図。 100……入力装置、200……補間器、201……線分分割
器、202……曲線演算器、203……座標値算出器、▲
▼……点P1の位置のベクトル、▲▼……点P1での進
行方向のベクトル、P2……点P2の位置ベクトル、q2……
点P2での進行方向のベクトル。
FIG. 1 is a diagram showing an embodiment of the present invention. FIGS. 2A to 2F are views for explaining the principle of the interpolation method of the present invention. 100: Input device, 200: Interpolator, 201: Line segment divider, 202: Curve calculator, 203: Coordinate value calculator, ▲
▼ …… Vector of position of point P 1 , ▲ ▼ …… Vector of traveling direction at point P 1 , P 2 …… Position vector of point P 2 , q 2 ……
Vector of travel direction at point P 2 .

フロントページの続き (56)参考文献 特開 昭56−72704(JP,A) 特公 昭58−56895(JP,B2)Continuation of front page (56) References JP-A-56-72704 (JP, A) JP-B-58-56895 (JP, B2)

Claims (1)

【特許請求の範囲】[Claims] 【請求項1】任意の2点P1とP2間をなめらかな曲線で結
ぶ数値制御の曲線補間方式において、 点P1における位置ベクトルおよびその点での進行方向ベ
クトルおよび点P2における位置ベクトルおよびその点で
の進行方向ベクトルに基づき、点P1における曲率1/R1
よび点P2における曲率1/R2を算出し、 2点間の曲率を、点P1と点P2とを円周上の点として含む
円弧の曲率となるように予め定められた関数にしたがっ
て曲率1/R1から曲率1/R2間で順次変化させ、複数の補間
軌跡の座標値を算出することを特徴とする数値制御にお
ける曲線補間方式。
1. A numerical value-controlled curve interpolation method for connecting any two points P 1 and P 2 with a smooth curve, wherein a position vector at a point P 1 , a traveling direction vector at that point, and a position vector at a point P 2 and based on the traveling direction vector at that point, to calculate the curvature 1 / R 2 in the curvature 1 / R 1 and point P 2 at point P 1, a curvature between two points, the point P 1 and point P 2 It is possible to calculate the coordinate values of multiple interpolation loci by sequentially changing from curvature 1 / R 1 to curvature 1 / R 2 according to a predetermined function so that the curvature of an arc included as a point on the circumference is obtained. Curve interpolation method in the characteristic numerical control.
JP61115612A 1986-05-19 1986-05-19 Curve interpolation method in numerical control Expired - Lifetime JPH07104704B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP61115612A JPH07104704B2 (en) 1986-05-19 1986-05-19 Curve interpolation method in numerical control

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP61115612A JPH07104704B2 (en) 1986-05-19 1986-05-19 Curve interpolation method in numerical control

Publications (2)

Publication Number Publication Date
JPS62271004A JPS62271004A (en) 1987-11-25
JPH07104704B2 true JPH07104704B2 (en) 1995-11-13

Family

ID=14666958

Family Applications (1)

Application Number Title Priority Date Filing Date
JP61115612A Expired - Lifetime JPH07104704B2 (en) 1986-05-19 1986-05-19 Curve interpolation method in numerical control

Country Status (1)

Country Link
JP (1) JPH07104704B2 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2790643B2 (en) * 1989-02-20 1998-08-27 三菱電機株式会社 Numerical control unit
JP3242162B2 (en) * 1992-08-21 2001-12-25 日本板硝子株式会社 NC processing method
US12605835B2 (en) 2023-06-20 2026-04-21 Lincoln Global, Inc. Collaborative robot welding system

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5672704A (en) * 1979-11-19 1981-06-17 Koyo Seiko Co Ltd Determining method for profiling work information of profiling work system
JPS5750010A (en) * 1980-09-08 1982-03-24 Fanuc Ltd Numeric control system
JPS59180604A (en) * 1983-03-31 1984-10-13 Hitachi Ltd Continuous trajectory generation device for robots
JPS60262214A (en) * 1984-06-06 1985-12-25 Nippei Toyama Corp Correction method of working center route

Also Published As

Publication number Publication date
JPS62271004A (en) 1987-11-25

Similar Documents

Publication Publication Date Title
Vendittelli et al. Obstacle distance for car-like robots
CN111791236A (en) A Cartesian Space Trajectory Transition Method for Industrial Robots
CN105082156B (en) Space trajectory smoothing method based on speed optimum control
US5109340A (en) Path planning method for mobile robots
WO2019041657A1 (en) Quintic polynomial trajectory planning method for industrial robot
CN108073138A (en) Suitable for the elliptic arc smooth compression interpolation algorithm of high speed and high precision processing
Feletti et al. Uniform circle formation for swarms of opaque robots with lights
CN112508227B (en) A rapid calculation method for regional target visible windows in complex conical fields of view of remote sensing satellites
CN115808900A (en) Tool motion data processing method and device, machining equipment and storage medium
Misro et al. Extended analysis of dynamic parameters on cubic trigonometric Bézier transition curves
JPH07104704B2 (en) Curve interpolation method in numerical control
CN111024082A (en) Method and device for planning local path of robot and robot
JP4146549B2 (en) Trajectory control method and recording medium having recorded trajectory control method
CN116520822B (en) Smooth curvature parameterized representation path generation method
CN118617407A (en) A robot arm trajectory blending control method and device
JP2648815B2 (en) Trajectory interpolation control device
Epkey et al. Elliptic triangles which are congruent to their polar triangles
US20220410393A1 (en) Method of Controlling Industrial Actuator, Control System and Actuator System
Frego et al. Point-clothoid distance and projection computation
JPH06259567A (en) Free curve interpolation method
JPS6333167B2 (en)
JPH10198812A (en) Free-form surface approximation method
JPS59218914A (en) Method for correcting hybrid of direction sensor
JPH07210688A (en) Device for calculating polygon area
Mukherjee An error reduced and uniform parameter approximation in fitting of B-spline curves to data points