附录3:四足步态算法及其控制代码/************************************工程名:DOG*文件名:main
c*功能:上位机步态算法平台
*CPU:M167
3728MHZ晶振*作者:YY*当前版本:1
0*日期:2008-4-2************************************/#include#include#include#include//#include#include"gait
h"#include"usart
h"#include"think
h"#include"ad
h"unsignedcharsend_pwm[9]={53,18,34,67,39,63,50,23,45};//PWM参数数组unsignedcharup_t=0;//时钟更新标志unsignedchart;//步态时钟节拍unsignedcharerror=0;//错误标志unsignedchart_backup;//t的备份unsignedcharone_T=0;/*******************************************************************定时器0用来产生步态时钟,定时器1和2用来产生PWM波,调配输出光色******************************************************************/voidtime_init(void){TCCR0=(0