EmbodiedAI
/
z1_sdk
mirror of https://github.com/unitreerobotics/z1_sdk.git
3
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

fix comment about "twsit"

This commit is contained in:
Agnel Wang 2022-12-14 20:27:01 +08:00
parent 2824dc0b41
commit 29bdbad6eb
2 changed files with 11 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
examples/highcmd_basic.cpp
View File

@ -53,7 +53,7 @@ void Z1ARM::armCtrlInCartesian(){
for(int i(0); i<1000;i++){
directions<< 0, 0, 0, 0, 0, -1, 0;
cartesianCtrlCmd(directions, 0., 0.1);
cartesianCtrlCmd(directions, 0.3, 0.1);
usleep(_ctrlComp->dt*1000000);
}
}

17
include/unitree_arm_sdk/control/unitreeArm.h
View File

@ -134,7 +134,7 @@ bool MoveC(Vec6 middlePosutre, Vec6 endPosture, double gripperPos, double maxSpe
* if you run function startTrack(ArmFSMState::CARTESIAN),
* firstly, the following parameters will be set at the first time:
* twist.setZero()
* then you can change it to control robot
* then you can change it to control robot, [Based on the object coordinate system]
*/
void startTrack(ArmFSMState fsm);
/*
@ -186,7 +186,8 @@ void setWait(bool Y_N);
void jointCtrlCmd(Vec7 directions, double jointSpeed);
/*
* Function: set spatial velocity command automatically by input parameters
* Function: set spatial velocity command automatically by input parameters
Based on the object coordinate system
* Input: directions: movement directions [include gripper], range:[-1,1]
* raw, pitch, yaw, x, y, z, gripper
* oriSpeed: range: [0, 0.6]
@ -196,11 +197,13 @@ void jointCtrlCmd(Vec7 directions, double jointSpeed);
* Description: The function is typically used to control the robot by keyboard or joystick
* When a key is pressed, the directions[i] is set to 1 or -1, and the function will
* automatically execute the following command:
* Tdelta = directions * speed
* Tgoal = Tdelta * Tpast
* omega = so3ToVec(MatrixLog3( Tpast.Rot.Transpose * Tgoal.Rot ))
* v = Tdelta.t
* twist = (omega, v)
* postureDelta = directions * speed
* postureGoal = postureDelta + posturePast
* Tgoal = postureToHomo(postureGoal)
* Tpast = postureToHomo(posturePast)
* omega = so3ToVec(MatrixLog3( Tpast.Rot.Transpose * Tgoal.Rot ))
* v = Tdelta.t
* twist = (omega, v)
* if directions == 0, the robot stop moving
*/
void cartesianCtrlCmd(Vec7 directions, double oriSpeed, double posSpeed);