附录3：四足步态算法与其控制代码.docVIP

下载本文档

20
0
约1.53万字
约 18页
2017-06-04 发布于北京
举报
版权申诉

附录3：四足步态算法与其控制代码.doc

1、原创力文档（book118）网站文档一经付费（服务费），不意味着购买了该文档的版权，仅供个人/单位学习、研究之用，不得用于商业用途，未经授权，严禁复制、发行、汇编、翻译或者网络传播等，侵权必究。。
2、本站所有内容均由合作方或网友上传，本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺！文档内容仅供研究参考，付费前请自行鉴别。如您付费，意味着您自己接受本站规则且自行承担风险，本站不退款、不进行额外附加服务；查看《如何避免下载的几个坑》。如果您已付费下载过本站文档，您可以点击这里二次下载。
3、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等，请点击“版权申诉”（推荐），也可以打举报电话：400-050-0827(电话支持时间：9:00-18:30)。
4、该文档为VIP文档，如果想要下载，成为VIP会员后，下载免费。
5、成为VIP后，下载本文档将扣除1次下载权益。下载后，不支持退款、换文档。如有疑问请联系我们。
6、成为VIP后，您将拥有八大权益，权益包括：VIP文档下载权益、阅读免打扰、文档格式转换、高级专利检索、专属身份标志、高级客服、多端互通、版权登记。
7、VIP文档为合作方或网友上传，每下载1次，网站将根据用户上传文档的质量评分、类型等，对文档贡献者给予高额补贴、流量扶持。如果你也想贡献VIP文档。上传文档

附录3：四足步态算法及其控制代码 /*********************************** *工程名：DOG *文件名：main.c *功能：上位机步态算法平台。 *CPU：M16 7.3728MHZ晶振 *作者：YY *当前版本：1.0 *日期：2008-4-2 ************************************/ #include avr/io.h #include avr/interrupt.h #include avr/wdt.h #include util/delay.h //#include avr/signal.h #include gait.h #include usart.h #include think.h #include ad.h unsigned char send_pwm[9]={53,18,34,67,39,63,50,23,45}; //PWM参数数组 unsigned char up_t=0; //时钟更新标志 unsigned char t; //步态时钟节拍 unsigned char error=0; //错误标志 unsigned char t_backup; //t的备份 unsigned char one_T=0; /****************************************************************** *定时器0用来产生步态时钟，定时器1和2用来产生PWM波，调配输出光色 ******************************************************************/ void time_init(void) { TCCR0=(0FOC0)|(0WGM00)|(0WGM01)|(0COM00)|(0COM01)|(0CS02)|(0CS01)|(0CS00); //1024分频 OCR0=38; //设置步态时钟节拍 TIMSK=(1OCIE0)|(0TOIE0); TCCR2=(0FOC0)|(1WGM20)|(1WGM21)|(0COM20)|(1COM21)|(1CS22)|(0CS21)|(0CS20); //快速PWM模式，比较匹配清零 TCCR1A=(1COM1A1)|(0COM1A0)|(1COM1B1)|(0COM1B0)|(0FOC1A)|(0FOC1B)|(0WGM11)|(1WGM10); //8位快速PWM模式，比较匹配清零 TCCR1B=(0WGM13)|(1WGM12)|(0CS12)|(1CS11)|(1CS10); } void io_init() { DDRB|=(0PB0); DDRD=(1PD5)|(1PD7); } /***********产生步态时钟************************/ SIGNAL(SIG_OUTPUT_COMPARE0) { if(t105) { t=0; one_T=1; } else t++; up_t=1; } /**********容错处理，USART接收中断**************/ SIGNAL(SIG_UART_RECV) { if(N==UDR) { error=1; } } int main(void) { cli(); wdt_disable(); io_init(); usart_init(); time_init(); sei(); usart_send_pwm(); //位置初始化 find_do(); } /*********************************** *工程名：DOG *文件名：gait.c *功能：步态算法函数文件。 *当前版本：1.0 *日期：2008-4-2 ************************************/ /*********************************** *当前版本：2.0 *步态参数事先计算，更改相关函数 *日期：2008-4-10 ************************************/ #include gait.h const prog_uchar t_a1[]={ // 1#膝关节 53,51,46,41,35,29,24,20,16,14,13,13,14,16,20,24,29,35,41,46,51,53, 53,52,52,52,51,51,51,51,50,50,5