AiStarter User Guide 6AI-Starter Demo
IssueV1.0.3(2018-09-01) AiStarter User Guide Copyright © Yuejiang Technology Co., Ltd
28
2) Set AI-Starter carrying position.
Program 6.17 Set carring position
float trayPoint[4][3] = {
{308.12, 25.92, 28},
{308.12, -15.92, 28},
{258.12, 25.92, 28},
{258.12, -15.92, 28}
};
3) Magician grabs cubes to AI-Starter.
Program 6.18 Grab cude
void AreaToAIStarter()
{
for(uint8_t i=0; i<4; i++){
Dobot_SetPTPCmdEx(JUMP_XYZ, AreaPoint[i][0], AreaPoint[i][1], AreaPoint[i][2], 0);
Dobot_SetEndEffectorSuctionCupEx(true);
Dobot_SetPTPCmdEx(MOVL_XYZ, AreaPoint[i][0], AreaPoint[i][1], AreaPoint[i][2]+70, 0);
Dobot_SetPTPCmdEx(JUMP_XYZ, trayPoint[i][0], trayPoint[i][1], trayPoint[i][2], 0);
Dobot_SetEndEffectorSuctionCupEx(false);
Dobot_SetPTPCmdEx(MOVL_XYZ, trayPoint[i][0], trayPoint[i][1], trayPoint[i][2]+30, 0);
}
Dobot_SetPTPCmdEx(MOVJ_XYZ, InitPositionX, InitPositionY, InitPositionZ, InitPositionR);
}
4) Initialize Pixy and Magician.
Program 6.19 Initialize Pixy and Magician
pixy.init();
Dobot_Init();
5) Detect cube number.
Program 6.20 Detect cube number
pixy.ccc.getBlocks();