黄工无刷电机学习
直播中

雅博电子科技

13年用户 548经验值
擅长:2223
私信 关注
[问答]

怎样去编写main函数的循环程序

怎样去编写main函数的循环程序?

脉冲发生函数的程序该如何去编写?

回帖(1)

毛玲燕

2021-10-15 10:13:59
  宏定义:
  #define DI_FOWARD (1 《《 0)
  #define DI_REVERSE (1 《《 1)
  #define FOWARD_FREQ 1000
  #define REVERSE_FREQ 1000
  #define MAX_FREQ 2000
  #define ACC 20000
  main函数的循环:
  while (!exit_flag)
  {
  read_iofpga(fd, 0x30, &di_pdata, sizeof(di_pdata));
  if ((di_pdata & DI_FOWARD) && !(di_pdata & DI_REVERSE))
  target_freq = FOWARD_FREQ;
  else if (!(di_pdata & DI_FOWARD) && (di_pdata & DI_REVERSE))
  target_freq = -REVERSE_FREQ;
  else
  target_freq = 0;
  read_iofpga(fd, 0xe2, &fifo_len, sizeof(fifo_len));
  fifo_len = 1024 - fifo_len 》 25 ? 0 : 25 - (1024 - fifo_len);
  generate_dda_data(fifo_len, ¤t_freq, target_freq, dda_data);
  write_iofpga_fifo(fd, 0x100, dda_data, sizeof(short) * 8 * fifo_len);
  usleep(10000);
  }
  脉冲发生函数:
  void generate_dda_data(int fifo_len, int * current_freq, int target_freq, short dda_data[][8])
  {
  int i = 0;
  *current_freq = *current_freq 》 MAX_FREQ ? MAX_FREQ : *current_freq;
  *current_freq = *current_freq 《 -MAX_FREQ ? -MAX_FREQ : *current_freq;
  target_freq = target_freq 》 MAX_FREQ ? MAX_FREQ : target_freq;
  target_freq = target_freq 《 -MAX_FREQ ? -MAX_FREQ : target_freq;
  while (i 《 fifo_len)
  {
  if (*current_freq 《 target_freq)
  {
  *current_freq += ACC / 1000;
  *current_freq = *current_freq 》 target_freq ? target_freq : *current_freq;
  }
  else
  {
  *current_freq -= ACC / 1000;
  *current_freq = *current_freq 《 target_freq ? target_freq : *current_freq;
  }
  calcul_freq += *current_freq;
  if (calcul_freq 》 0)
  dda_data[0] = calcul_freq / 1000;
  else
  dda_data[0]= (-calcul_freq / 1000) | 0x8000;
  calcul_freq %= 1000;
  i++;
  }
  }
举报

更多回帖

发帖
×
20
完善资料,
赚取积分