#include <stdio.h>

#include <stdint.h>
#include <unistd.h>
#include "by_cmd.h"
#include "logc/log.h"

#include "by_serial.h"

char test_data[] = "hello world\r\n";
char buff[20]    = {0};

uint8_t cmd_temp;
uint32_t buff_temp[20];

int main(int argc, char **argv)
{
  log_set_level(LOG_INFO);

  if (by_cmd_init()) {
    log_error("Program exits abnormally");
    return -1;
  }

  by_cmd_send_distance_x(12, 100);
  by_cmd_send_angle_camera(20.0);
  by_cmd_send_position_axis_z(0x11, 100);
  by_cmd_send_distance_axis_z(10, 20);
  by_cmd_send_distance_axis_x(4, 100);
  by_cmd_send_position_axis_x(4, 0);
  by_cmd_send_angle_claw_arm(34);
  by_cmd_send_angle_claw_arm(220);
  by_cmd_send_angle_claw(27);
  sleep(1);
  by_cmd_send_distance_axis_x(4, -60);

  return 0;
}