6-2 步进电动实现两轴联动直线运动程序.docVIP

下载本文档

4
0
约 7页
2016-11-22 发布于贵州
举报
版权申诉

6-2 步进电动实现两轴联动直线运动程序.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文档。上传文档

6-2 步进电动实现两轴联动直线运动程序

《步进电动机实现两轴联动直线运动程序》 .equ __30F6010, 1 .include C:\Program Files\Microchip\MPLAB ASM30 Suite\Support\inc\p30f6010.inc .global __reset .global __OC7Interrupt .global __OC8Interrupt config __FOSC, CSW_FSCM_OFF XT_PLL4 config __FWDT, WDT_OFF config __FBORPOR, PBOR_ON BORV_27 PWRT_16 MCLR_EN config __FGS, CODE_PROT_OFF .bss XAL: .space 2 XBL: .space 2 YAL: .space 2 YBL: .space 2 XAH: .space 2 XBH: .space 2 YAH: .space 2 YBH: .space 2 tL: .space 2 tH: .space 2 ; K: .space 2 dXL: .space 2 dYL: .space 2 dXH: .space 2 dYH: .space 2 Tx: .space 2 Ty: .space 2 DIR: .space 2 NXL: .space 2 NXH: .space 2 NYL: .space 2 NYH: .space 2 Testx: .space 2 Testy: .space 2 .text __reset: mov #__SP_init, W15 mov #__SPLIM_init, W0 mov W0, SPLIM nop clr W0 mov W0, W14 repeat #12 mov W0, [++W14] clr W14 MOV #0x0001, w0 MOV w0, OC7CON BSET OC7CON, #1 MOV #0x0009, w0 MOV w0, OC8CON BSET OC8CON, #1 Mov #0xFFFC,w0 Mov w0,TRISG Mov #0x5544,w0 Mov w0,IPC8 Clr IFS2 Clr Testx Clr Testy Bset SR,#C Mov XBL,W2 Mov XAL,W0 Sub w2,w0,w6 Mov XBH,w2 Mov XAH,w0 Subb w2,w0,w5 Bra n,TB1 Bra z,TB5 bclr DIR,#0 Goto TB2 TB1: Bset DIR,#0 Mov w6,ACCAL Mov w5,ACCAH Clr ACCAU Neg A Mov ACCAL,w6 Mov ACCAH,w5 TB2: Mov w6,ACCAL Mov w5,ACCAH Clr ACCAU Sftac A,#2 Mov ACCAL, w6 Mov ACCAH, w5 Mov w6, NXL Mov w5, NXH Sftac A,#2 Mov ACCAL, w0 Mov #68,w1 Mul.uu w0,w1,w2 Clr w4 Clr w5 Ff1l w3,w4 Bra nc,TB3 Ff1l w2,w5 Bra c,TB5 Mov #-16, w4 Subr w5,#1,w5 Mov w2,ACCAL Mov w3,ACCAH Clr ACCAU Sftac A,w4 Sftac A,w5 Mov ACCAH,w6 Mov tL,w2 Mov tH,w3 Repeat #17 div.ud w2,w6 mov w0,ACCAL clr ACCAH sftac A,w4 sftac A,w5 Goto TB4 TB3: Subr w4,#1,w4 Mov w2,ACCAL Mov w3,ACCAH Clr ACCAU Sftac A,w4 Mov ACCAH,w6 Mov tL,w2 Mov tH,w3 Repeat #17 div.ud w2