auxiliary_sample_addition_new/Usr/module/feite_servo/servo_operation.c

#include "servo_operation.h"

#include <stdbool.h>
#include <stdio.h>
#include <string.h>

static UART_HandleTypeDef* m_uart;

static uint8_t tx_buf[PROCESS_MAX_LEN];
static uint8_t rx_buf[PROCESS_MAX_LEN];
static uint8_t tx_send_len;

static uint8_t cmd_type;

static uint8_t check_sum;

// ����Ҫһ����Я���Ĵ�����Ϣ�ı���
static reg_info_t reg_info;



/**
 * @description: �������ڳ�ʼ��
 * @param {UART_HandleTypeDef*} uart
 * @return {*}
 */
void servo_uart_init(UART_HandleTypeDef* uart) { m_uart = uart; }

/**
 * @description: ���
 * @param {servo_obj_t*} servo ��������
 * @return {*}
 */
bool Write_operete(uint8_t id, uint8_t cmd, param_t* param) {
  reg_distinguish(param, &reg_info);

  if (cmd != SYC_W_DATA)
    cmd_type = non_syn;
  else
    cmd_type = syn;

  write_reg(id, cmd, param);
  return true;
}

void Ping_operete(uint8_t id) {
  cmd_basic_t* cmd_basic = (cmd_basic_t*)tx_buf;
  cmd_basic->head        = 0xffff;
  cmd_basic->id          = id;
  cmd_basic->valid_len   = 0x02;
  cmd_basic->cmd         = PING;

  check_sum = check_sum_calculate(&tx_buf[2], NULL);
  memcpy(&tx_buf[BASCI_LEN], &check_sum, 1);
  tx_send_len = BASCI_LEN + 1;  // 1 = check_sum
  packet_process(m_uart, tx_buf, rx_buf, tx_send_len);
}

// ��ʼ�����޷�ȷ�����Ͳ����ij��ȣ�����һ�����鵫�ǵ���ָ�������������Ը��˸�����
/**
 * @description:
 * @param {uint8_t} id
 * @param {uint8_t} cmd
 * @param {param_t*} param
 * @return {*}
 */
void write_reg(uint8_t id, uint8_t cmd, param_t* param) {
  uint8_t      param_real_len = param->count * reg_info.data_len;  // ��������*ÿ���������� = ʵ�ʲ�������
  cmd_basic_t* cmd_basic      = (cmd_basic_t*)tx_buf;              // �����������ݲ�����������
  uint8_t*     cmd_param      = &tx_buf[5];

  cmd_basic->head = 0xffff;
  cmd_basic->id   = id;

  if (cmd_type) {
    cmd_basic->valid_len = param_real_len + 3;  // cmd + id + check_sum = 3
    cmd_basic->cmd       = cmd;
    cmd_param[0]         = param->addr;
    // �жϲ������ݳ���
    if (reg_info.data_len == byte) {
      memcpy(&cmd_param[1], param->data, param->count);
    } else if (reg_info.data_len == word) {
      // �ߵ�λ�����������ļĴ�����ַ����Ҫ����
      high_low_exchange(param, &cmd_param[1], &reg_info);
    }
  }
  // else ͬ���ͷ�ͬ���޷��ϲ�Ϊһ������
  check_sum = check_sum_calculate(&tx_buf[2], param);
  // ��checksum����ָ����ĩβ
  memcpy(&tx_buf[BASCI_LEN + param_real_len + 1], &check_sum, 1);  // tx_buff[5] == addr    1 = addr

  tx_send_len = BASCI_LEN + param_real_len + 2;  // 2 = addr + check_sum
  packet_process(m_uart, tx_buf,rx_buf, tx_send_len);
}