geometricJacobian

로봇 컨피규레이션에 대한 기하 야코비 행렬

구문

jacobian = geometricJacobian(robot,configuration,endeffectorname)

jacobian = geometricJacobian(robot,configuration,framename)

설명

jacobian = geometricJacobian(robot,configuration,endeffectorname) 은 로봇 모델에 지정된 엔드 이펙터 이름과 컨피규레이션에 대한 베이스를 기준으로 기하 야코비 행렬을 계산합니다.

jacobian = geometricJacobian(robot,configuration,framename)은 framename에 의해 지정된 프레임에 대한 기하 야코비 행렬을 계산합니다.

예제

로봇 컨피규레이션에 대한 기하 야코비 행렬

로봇의 특정 엔드 이펙터와 컨피규레이션에 대한 기하 야코비 행렬을 계산합니다.

Robotics System Toolbox™ loadrobot 함수를 사용하여 PUMA 560 로봇을 rigidBodyTree 객체로 불러옵니다.

puma = loadrobot("puma560");

무작위 컨피규레이션을 적용한 Puma 로봇에서 바디 "link7"의 기하 야코비 행렬을 계산합니다.

geoJacob = geometricJacobian(puma,randomConfiguration(puma),"link7")

geoJacob = 6×6

   -0.0000   -0.5752   -0.5752   -0.4266   -0.7683   -0.5213
    0.0000    0.8180    0.8180   -0.3000   -0.3776    0.8377
    1.0000   -0.0000   -0.0000    0.8533   -0.5168    0.1629
    0.1696    0.0823    0.3087   -0.0407    0.0198         0
   -0.5577    0.0578    0.2171   -0.0200    0.0210         0
    0.0000    0.5538    0.2224   -0.0274   -0.0448         0

입력 인수

robot — 로봇 모델

rigidBodyTree 객체

로봇 모델로, rigidBodyTree 객체로 지정됩니다.

configuration — 로봇 컨피규레이션

벡터 | 구조체

로봇 컨피규레이션으로, 로봇 모델의 모든 바디에 대한 조인트 이름과 위치를 나타내는 구조체 또는 조인트 위치 벡터로 지정됩니다. homeConfiguration(robot), randomConfiguration(robot)을 사용하거나 구조체에 조인트 위치를 직접 지정하여 컨피규레이션을 생성할 수 있습니다. 벡터 형식의 configuration을 사용하려면 robot의 DataFormat 속성을 "row" 또는 "column"으로 설정합니다.

endeffectorname — 엔드 이펙터 이름

string형 스칼라 | 문자형 벡터

엔드 이펙터 이름으로, string형 스칼라 또는 문자형 벡터로 지정됩니다. 로봇 모델의 어떤 바디도 엔드 이펙터가 될 수 있습니다.

데이터형: char | string

framename — 프레임 이름

string형 스칼라 | 문자형 벡터

프레임 이름으로, string형 스칼라 또는 문자형 벡터로 지정됩니다. 이 프레임은 로봇 모델에서 어떠한 프레임도 될 수 있습니다.

데이터형: char | string

출력 인수

jacobian — 기하 야코비 행렬

6×n 행렬

configuration이 지정된 엔드 이펙터의 기하 야코비 행렬로, 6×n 행렬로 반환됩니다. 여기서 n은 로봇의 자유도입니다. 야코비 행렬은 베이스 좌표 프레임을 기준으로 엔드 이펙터에 조인트-공간 속도를 매핑합니다. 엔드 이펙터 속도는 다음과 같습니다.

ω는 각속도, υ는 선속도, 는 조인트-공간 속도입니다.

세부 정보

동역학 속성

로봇 동역학을 사용하여 작업하는 경우 rigidBody 객체의 다음 속성을 사용하여 매니퓰레이터 로봇의 개별 바디에 대한 정보를 지정합니다.

• Mass — 강체의 질량(단위: 킬로그램).

• CenterOfMass — 강체의 질량 중심 위치로, [x y z] 형식의 벡터로 지정됩니다. 이 벡터는 바디 프레임을 기준으로 강체의 질량 중심 위치를 설명합니다(단위: 미터). centerOfMass 객체 함수는 로봇의 질량 중심을 계산할 때 이 강체 속성값을 사용합니다.

• Inertia — 강체의 관성으로, [Ixx Iyy Izz Iyz Ixz Ixy] 형식의 벡터로 지정됩니다. 이 벡터는 바디 프레임을 기준으로 합니다(단위: 킬로그램 제곱미터). 관성 텐서는 양의 정부호 행렬로, 형식은 다음과 같습니다.

  

  Inertia 벡터의 처음 세 요소는 관성 모멘트이며, 관성 텐서의 대각선 요소입니다. 벡터의 마지막 세 요소는 관성의 곱이며, 관성 텐서의 비대각선 요소입니다.

전체 매니퓰레이터 로봇 모델과 관련된 정보의 경우 다음 rigidBodyTree 객체 속성을 지정합니다.

• Gravity — 로봇에 작용하는 중력 가속도로, [x y z] 벡터로 지정됩니다(단위: m/s²). 기본적으로 중력 가속도는 없습니다.

• DataFormat — 기구학 함수와 동역학 함수의 입력/출력 데이터 형식으로, "struct", "row" 또는 "column"으로 지정됩니다.

동역학 방정식

매니퓰레이터 강체 동역학은 다음 방정식에 의해 결정됩니다.

$$\frac{d}{dt}\left[\begin{array}{c}q\\ \dot{q}\end{array}\right]=\left[\begin{array}{c}\dot{q}\\ M{(q)}^{-1}\left(-C(q,\dot{q})\dot{q}-G(q)-J{(q)}^T{f}_{Ext}+\tau \right)\end{array}\right]$$

또는 다음과 같이 표기합니다.

$$M(q)\ddot{q}=-C(q,\dot{q})\dot{q}-G(q)-J{(q)}^T{f}_{Ext}+\tau$$

각 요소는 다음과 같습니다.

• $$M(q)$$ — 현재의 로봇 컨피규레이션에 기반한 조인트-공간 질량 행렬입니다. 이 행렬은 massMatrix 객체 함수를 사용하여 계산합니다.

• $$C(q,\dot{q})$$ — 속도 곱을 계산하기 위해 $$\dot{q}$$를 곱한 코리올리 항입니다. 속도 곱은 velocityProduct 객체 함수를 사용하여 계산합니다.

• $$G(q)$$ — 모든 조인트가 지정된 중력 Gravity에서 위치를 유지하는 데 필요한 중력 토크와 중력 힘입니다. 중력 토크는 gravityTorque 객체 함수를 사용하여 계산합니다.

• $$J(q)$$ — 지정된 조인트 컨피규레이션에 대한 기하 야코비 행렬입니다. 기하 야코비 행렬은 geometricJacobian 객체 함수를 사용하여 계산합니다.

• $$f_{Ext}$$ — 강체에 가해지는 외력의 행렬입니다. 외력은 externalForce 객체 함수를 사용하여 생성합니다.

• $$\tau$$ — 각 조인트에 벡터로 직접 가해지는 조인트 토크와 조인트 힘입니다.

• $$q,\dot{q},\ddot{q}$$ — 개별 벡터로, 각각 조인트 컨피규레이션, 조인트 속도, 조인트 가속도입니다. 회전 조인트의 경우 각각 라디안, rad/s, rad/s² 단위로 값을 지정합니다. 직선 조인트의 경우 미터, m/s, m/s² 단위로 지정합니다.

동역학을 직접 계산하려면 forwardDynamics 객체 함수를 사용합니다. 이 함수는 상기 입력값들의 지정된 조합에 대한 조인트 가속도를 계산합니다.

일련의 특정 모션을 구현하려면 inverseDynamics 객체 함수를 사용합니다. 이 함수는 지정된 컨피규레이션, 속도, 가속도, 외력을 구현하는 데 필요한 조인트 토크를 계산합니다.

참고 문헌

[1] Featherstone, Roy. Rigid Body Dynamics Algorithms. Springer US, 2008. DOI.org (Crossref), doi:10.1007/978-1-4899-7560-7.

확장 기능

C/C++ 코드 생성

MATLAB® Coder™를 사용하여 C 코드나 C++ 코드를 생성할 수 있습니다.

사용법 관련 참고 사항 및 제한 사항:

rigidBodyTree 객체를 만들 때 MaxNumBodies로 로봇 모델에 추가할 수 있는 바디의 상한을 지정하는 구문을 사용하십시오. 또한 DataFormat 속성을 이름-값 쌍으로 지정해야 합니다. 예를 들면 다음과 같습니다.

robot = rigidBodyTree("MaxNumBodies",15,"DataFormat","row")

데이터 사용량을 최소화하기 위해 모델에서 예상되는 바디 개수에 가까운 수로 상한을 설정하십시오. 코드 생성 시 모든 데이터 형식이 지원됩니다. 동역학 함수를 사용하기 위해 데이터 형식을 "row" 또는 "column"으로 설정해야 합니다.

show 및 showdetails는 코드 생성을 지원하지 않습니다.

버전 내역

R2016b에 개발됨

R2025a: geometricJacobian 방법에 프레임 이름이 통합됨

geometricJacobian 방법은 이제 기하 야코비 행렬을 계산하기 위한 바디 이름이나 프레임 이름을 입력 인수로 받습니다.

R2024a: 정적 메모리 할당 지원

geometricJacobian 함수는 이제 동적 메모리 할당 비활성화를 통한 코드 생성을 지원합니다. 동적 메모리 할당 비활성화에 대한 자세한 내용은 Set Dynamic Memory Allocation Threshold (MATLAB Coder) 항목을 참조하십시오.

참고 항목

getTransform | homeConfiguration | randomConfiguration | rigidBodyJoint | rigidBody

도움말 항목

• 엔드포인트 힘과 모멘트의 균형을 맞추기 위해 조인트 토크 계산하기