BHand library
Contents |
BHand Library
This instruction shows you how to include BHand library and use api.
Also, you need to install BHand library. "libBHand": Grasping_Library_for_Linux
Edit CMakeLists.txt
- Edit CMakeLists.txt for building.
add_executable (grasp main.cpp canAPI.cpp) target_link_libraries (grasp BHand pcanbasic pthread) install (TARGETS grasp DESTINATION ${PROJECT_BINARY_DIR}/bin)
Edit main.cpp
- Include BHand library.
#include <BHand/BHand.h>
- Variable declaration for BHand library
// USER HAND CONFIGURATION const bool RIGHT_HAND = true; const int HAND_VERSION = 4; // for BHand library BHand* pBHand = NULL; double q[MAX_DOF]; // joint position double q_des[MAX_DOF]; // desired joint position used in joint pd control motion double tau_des[MAX_DOF]; // desired joint torque double cur_des[MAX_DOF]; // current joint torque const double tau_cov_const_v4 = 1200.0; // 1200.0 for SAH040xxxxx
- Additional function declarations
// functions declarations char Getch(); void MainLoop(); bool OpenCAN(); void CloseCAN(); bool CreateBHandAlgorithm(); // create void DestroyBHandAlgorithm(); // destroy void ComputeTorque(); // torque compute
- Add ComputeTorque function to get desired torque. In this part, you have to make sure that
case ID_RTR_FINGER_POSE_1: case ID_RTR_FINGER_POSE_2: case ID_RTR_FINGER_POSE_3: case ID_RTR_FINGER_POSE_4: { int findex = (id & 0x00000007); vars.enc_actual[findex*4 + 0] = (short)(data[0] | (data[1] << 8)); vars.enc_actual[findex*4 + 1] = (short)(data[2] | (data[3] << 8)); vars.enc_actual[findex*4 + 2] = (short)(data[4] | (data[5] << 8)); vars.enc_actual[findex*4 + 3] = (short)(data[6] | (data[7] << 8)); data_return |= (0x01 << (findex)); // counting 4 fingers // If you have received all four finger data, set new desired torque. // This can create a stable interval time of 3 ms to prevent overshoot. if (data_return == (0x01 | 0x02 | 0x04 | 0x08)) { // convert encoder count to joint angle for (i=0; i<MAX_DOF; i++) { q[i] = (double)(vars.enc_actual[i])*(333.3/65536.0)*DEG2RAD; } ComputeTorque(); // convert desired torque to desired current and PWM count for (int i=0; i<MAX_DOF; i++) { cur_des[i] = tau_des[i]; // set limit if (cur_des[i] > 1.0) cur_des[i] = 1.0; else if (cur_des[i] < -1.0) cur_des[i] = -1.0; } for (int i=0; i<4;i++) { vars.pwm_demand[i*4+0] = (short)(cur_des[i*4+0]*tau_cov_const_v4); vars.pwm_demand[i*4+1] = (short)(cur_des[i*4+1]*tau_cov_const_v4); vars.pwm_demand[i*4+2] = (short)(cur_des[i*4+2]*tau_cov_const_v4); vars.pwm_demand[i*4+3] = (short)(cur_des[i*4+3]*tau_cov_const_v4); command_set_torque(CAN_Ch, i, &vars.pwm_demand[4*i]); } data_return = 0; } break; }
- Make more commands by using BHand library api.
switch (c) { case 'q': if (pBHand) pBHand->SetMotionType(eMotionType_NONE); bRun = false; break; case 'h': if (pBHand) pBHand->SetMotionType(eMotionType_HOME); break; case 'r': if (pBHand) pBHand->SetMotionType(eMotionType_READY); break; case 'g': if (pBHand) pBHand->SetMotionType(eMotionType_GRASP_3); break; case 'k': if (pBHand) pBHand->SetMotionType(eMotionType_GRASP_4); break; case 'p': if (pBHand) pBHand->SetMotionType(eMotionType_PINCH_IT); break; case 'm': if (pBHand) pBHand->SetMotionType(eMotionType_PINCH_MT); break; case 'a': if (pBHand) pBHand->SetMotionType(eMotionType_GRAVITY_COMP); break; case 'e': if (pBHand) pBHand->SetMotionType(eMotionType_ENVELOP); break; case 'f': if (pBHand) pBHand->SetMotionType(eMotionType_NONE); break; }
- Define functions
// Load and create grasping algorithm bool CreateBHandAlgorithm() { if (RIGHT_HAND) pBHand = bhCreateRightHand(); else pBHand = bhCreateLeftHand(); if (!pBHand) return false; pBHand->SetMotionType(eMotionType_NONE); pBHand->SetTimeInterval(delT); return true; } // Destroy grasping algorithm void DestroyBHandAlgorithm() { if (pBHand) { #ifndef _DEBUG delete pBHand; #endif pBHand = NULL; } } // Print program information and keyboard instructions void PrintInstruction() { printf("--------------------------------------------------\n"); printf("Keyboard Commands:\n"); printf("H: Home Position (PD control)\n"); printf("R: Ready Position (used before grasping)\n"); printf("G: Three-Finger Grasp\n"); printf("K: Four-Finger Grasp\n"); printf("P: Two-finger pinch (index-thumb)\n"); printf("M: Two-finger pinch (middle-thumb)\n"); printf("E: Envelop Grasp (all fingers)\n"); printf("A: Gravity Compensation\n\n"); printf("F: Servos OFF (any grasp cmd turns them back on)\n"); printf("Q: Quit this program\n"); printf("--------------------------------------------------\n\n"); }
- Edit main()
int main() { printf("myAllegrodHand: "); if (RIGHT_HAND) printf("Right Hand, v%i.x\n\n", HAND_VERSION); else printf("Left Hand, v%i.x\n\n", HAND_VERSION); PrintInstruction(); memset(&vars, 0, sizeof(vars)); memset(q, 0, sizeof(q)); memset(q_des, 0, sizeof(q_des)); memset(tau_des, 0, sizeof(tau_des)); memset(cur_des, 0, sizeof(cur_des)); if (CreateBHandAlgorithm() && OpenCAN()) MainLoop(); CloseCAN(); DestroyBHandAlgorithm(); return 0; }
Making Rock Paper Scissors by Allegro Hand
- PD control api : how to use PD control api.
Copyright & Trademark Notice
Allegro, the Allegro logo, RoboticsLab, the RoboticsLab logo, and all related files and documentation are Copyright ⓒ 2008-2020 Wonik Robotics Co., Ltd. All rights reserved. RoboticsLab and Allegro are trademarks of Wonik Robotics. All other trademarks or registered trademarks mentioned are the properties of their respective owners.
Wonik Robotics's Allegro Hand is based on licensed technology developed by the Humanoid Robot Hand research group at the Korea Institute of Industrial Technology (KITECH).
Any references to the BHand Library or the Allegro Hand Motion and/or Grasping Library refer to a library of humanoid robotic hand grasping algorithms and motions developed and published by KITECH researchers.
J.-H. Bae, S.-W. Park, D. Kim, M.-H. Baeg, and S.-R. Oh, "A Grasp Strategy with the Geometric Centroid of a Groped Object Shape Derived from Contact Spots," Proc. of the 2012 IEEE Int. Conf. on Robotics and Automation (ICRA2012), pp. 3798-3804
Wiki maintained by Sean Yi <seanyi@wonikrobotics.com>
| Whos here now: Members 0 Guests 1 Bots & Crawlers 0 |