SMC_Frame_DenavitHartenberg (FUN)
FUNCTION SMC_Frame_DenavitHartenberg : BOOL
Computes the affine-linear transformation based on the Denavit Hartenberg parameters. The transformation transforms from the joint coordinate system i to i-1.
InOut:
|
Scope |
Name |
Type |
|
Inout |
frDst |
|
|
Input |
dJointAngle_rad |
LREAL |
|
dLinkOffset_u |
LREAL |
|
|
dLinkLength_u |
LREAL |
|
|
dLinkTwist_sin |
LREAL |
|
|
dLinkTwist_cos |
LREAL |
|
|
Return |
SMC_Frame_DenavitHartenberg |
BOOL |
