-
Notifications
You must be signed in to change notification settings - Fork 29
/
8000-load_identify_current.cc
46 lines (37 loc) · 1.1 KB
/
8000-load_identify_current.cc
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
/**
* Software License Agreement (MIT License)
*
* Copyright (c) 2022, UFACTORY, Inc.
*
* All rights reserved.
*
* @author Vinman <vinman.wen@ufactory.cc> <vinman.cub@gmail.com>
*/
#include "xarm/wrapper/xarm_api.h"
void iden_progress_changed_callback(int progress) {
printf("progress: %d\n", progress);
}
int main(int argc, char **argv) {
if (argc < 2) {
printf("Please enter IP address\n");
return 0;
}
std::string port(argv[1]);
XArmAPI *arm = new XArmAPI(port);
sleep_milliseconds(500);
if (arm->error_code != 0) arm->clean_error();
if (arm->warn_code != 0) arm->clean_warn();
arm->motion_enable(true);
arm->set_mode(0);
arm->set_state(0);
sleep_milliseconds(500);
printf("=========================================\n");
arm->register_iden_progress_changed_callback(iden_progress_changed_callback);
printf("start iden tcp load\n");
int ret;
float result[4] = {0};
ret = arm->iden_tcp_load(result);
printf("ret=%d, result=[%f, %f, %f, %f]\n", ret, result[0], result[1], result[2], result[3]);
arm->release_iden_progress_changed_callback(true);
return 0;
}