thirdparty-set_robotiq_gripper_1.cc

/**
 * 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"


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();

  printf("=========================================\n");
  int ret;

  ret = arm->core->set_modbus_timeout(5);
  printf("set_modbus_timeout, ret=%d\n", ret);
  ret = arm->core->set_modbus_baudrate(115200);
  printf("set_modbus_baudrate, ret=%d\n", ret);
  sleep_milliseconds(1000);

  unsigned char recv_data[254] = {0};
  unsigned char modbus_data_1[13] = { 0x09, 0x10, 0x03, 0xE8, 0x00, 0x03, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
  ret = arm->core->tgpio_set_modbus(modbus_data_1, 13, recv_data);
  printf("tgpio_set_modbus, ret=%d\n", ret);
  printf("recv_data:");
  for (int i = 0; i < 254; ++i) { printf("%c ", recv_data[i]); }
  printf("\n");

  sleep_milliseconds(1000);

  unsigned char modbus_data_2[13] = { 0x09, 0x10, 0x03, 0xE8, 0x00, 0x03, 0x06, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00 };
  ret = arm->core->tgpio_set_modbus(modbus_data_2, 13, recv_data);
  printf("tgpio_set_modbus, ret=%d\n", ret);
  printf("recv_data:");
  for (int i = 0; i < 254; ++i) { printf("%c ", recv_data[i]); }
  printf("\n");

  return 0;
}