你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

PIC单片机在机器人的控制方面的设计

[复制链接]
gaosmile 发布时间:2020-3-26 14:25

本文介绍项目是有关机器人控制的实现。控制部分采用PICl6F7X系列单片机,运用汇编语言编程,运行速度较快,能够达到系统的要求。在这里使用的大多是数字信号的控制,电机的控制只有开和合两种状态。在动作的过程中需要两只手臂、身体、头部、脚部等的协调动作。整个控制系统比较复杂,因而在PIC程序编写和空间分配方面需要注意一些问题。

6 C6 ?. m0 j/ J8 M  b: e- S1 _

       

* U7 h$ y4 H: E  ^' ~

        1、 动作标志位的使用


: g) s- u- n/ ^( @. }

        在整个控制中,组合的动作很多,当所有动作定位都通过光电开关控制时,在程序编写上就有一些问题。如要求左手上升到鼓掌位、右手上升到举手位(手初始位置在最下的放下位),光电开关0有效(即为0时是挡住),到达正确位置。用简单的理解可以写成下面的程序:


) W6 A1 U3 Q- k+ \( e% o2 ]' w6 r

        list P=16c73

9 V. P8 Z) {+ p- Z) X- l" ?

        call lefthandup

3 H0 ~, }+ {7 p! A3 {8 c

        call righthandup

, X; h% Q6 m4 _+ g, J

        LO call readinsignal


: g2 M, y0 J, O6 b

        bdss csl_v,1efthandligbts

' V$ s* p5 S' ?, v6 H% N1 x

        call lefthandstop


" i" |) j* c. C0 x' S: c

        btfsc csl_v,righthandlight4


, F* x: F; J* G- e

        goto L0

) i% g) b6 C0 y8 D& @" Z7 u9 B/ h

        call righthandstop

6 L4 S' g# t* o0 l5 k% y2 [( v: }

        L1 call readinsignal

4 N) z, D6 p  r5 A9 c

        btfsc csl_v,lefthandlight3

0 ?' _! m  W, [$ Q2 \! p

        goto L1


0 @- P* Q' O0 B3 }

        call lefthandstop

# @7 ?+ ~0 p7 i) l' X+ b4 \0 `

        :


" Y/ @; x# @+ H0 f

        lefthandlight表示光电开关,由此判断是否到相应的位置。1表示在手臂最下面的位置;2表示在手臂的握手位置;3表示在手臂的鼓掌位置;4表示在手臂的高举手位置。上面程序描写左手臂上升到举手位置和右手臂上升到鼓掌位置并停止的过程。先判断左手到达否,到达则左手停止,接着看右手是否到达举手位,到达则停止,否则循环上述的检测,直到左手到达鼓掌位,右手到达举手位。

6 i' H- ^% Y+ v& L" X

        注意,这里的3,4表示的就是鼓掌位,举手位。经过循环检测可以让手臂停在各位上,然而机械动作是有惯性的,机械停止位可能在该位的上一点或下一点,这就影响下面动作的进行,可能在若干动作后机械动作出现失常,也就是程序没法正常的运行。在此情况下,需要修改程序的编写方式,采用标志位来控制动作的进行。如果采用控制标志位,一定要在动作子函数中对标志位置零。程序如下:


; M- `3 b% H* Z5 h% @% m2 N# Z1 d" o

        list p=16c73

6 D3 w0 I  t  h  q. `5 q

        :

% d) i: a7 t3 I& l2 x& N% A

        actlONstopflag equ Ox6e ;位定义


) C) Q, U4 X" i$ T& a

        lefthandfla8 cqu 0x0 ;0表示停止左手动作

3 S6 q( E4 Z' {# B

        rightbandflag equ Oxl ;O表示停止右手动作

7 m) t/ A  U6 l5 k2 L& Q7 v! q

        :


, S) _6 `  \) b- z0 ^9 {: Y

        movlw Ox03

7 S; Q! [& l4 [! {6 \

        movWf actionstopflag


9 o+ k0 k4 o: h' B4 L

        call lefthanduo

9 |0 `& }! A! G% ~/ E

        call righthandup


, Q0 f% z2 ]0 U& M! j

        L2 call readinsignal


$ p/ j% d2 k5 Z1 \: B

        btfss csl_v,lefthandhght3


% |# B3 b( o2 d- u5 {

        call lefthatldotop

# c. Z/ q( y# x( `+ S' Z; J

        btfss csl_v,righthandlight4


9 K$ _7 v2 @2 B6 k; q( q

        call righthandstop

  t5 w/ B7 \5 a

        movlw Ox00


2 ~8 |6 m; V% r3 n3 ~: M3 Y

        subwf acTIonstopflag,w

- m, `" D, k1 \

        btfss status,z


$ O8 m' Q4 X2 ]: ^* ]- h' h

        goto L2

2 R+ q6 m+ ]# L' u! J% y( |' y. H

        继续下面的程序


: k. f/ O& ~4 f2 M/ X* p8 U

        acTIonstopflag 表示动作标志位参数,给动作标志位赋值,动作停止函数中将清零标志位的值。上述程序和前面所述程序的功能一样,实现两支手臂的动作。上面程序描写左手是否到达鼓掌位,到达停止,右手是否到达举手位,到达停止。看动作标志位是否为零,不是,不断地循环检测;是,执行下面的程序。


, n2 }6 k( L+ `6 E) W5 \

        2 、GOTO,CALL指令的不同使用


2 V5 F/ `4 ~9 G/ q( V

        在PIC的汇编程序中,CALL与GOT0指冷使用的场合不同。一般情况下,在于程序与主程序之间大多用CALL指令;而状态转换模块之间大多用GOTO 指令,即由此状态进入另一种状态不需返回。由于PIC单片机的堆栈有限,在程序中,不能无止境地使用GOTO语句,这样会使堆栈溢出,程序无法正常运行。各个小程序内部循环占用堆栈的级数不多,使用GOTO指令是可行的,但在大的程序中用GOTO则无法返回到调用前程序的下一条指令。CALL指令完成调用完子程序后返回到调用前的程序。程序如下:

% E! C5 B; F/ N. v  c

        list D=16c76

  v- ~& t8 e1 I- g6 Z

        start:ca11 setcpu

  B+ M6 o0 I1 I) l% [

        call automatlsn、statel

# e, i: j& H# i9 q

        L3 call readinsignal

" k! R5 |; |0 p

        btfsc cs2_v,ultrasonicdetectl

! L! s7 r! F7 I1 M7 D

        goto L3

  |" z2 q6 g8 c% ~! I5 K! D0 ?' b

        goto autonatlsmstate2

" |) r4 l( ]7 k& ~; H! s

        :


% n9 q0 g. R. @% W2 V; j

        automatlsmstate2:

8 n6 m) P/ G* }1 `, R6 F) c1 N

        return

+ f, v, G2 r, Q! b3 }

        auatomaTIsmstatel、 automaTIsmstate2表示两种状态,uhrasonicdetectl表示一个输入超声检测信号。上面程序描写调用 automatistmstate1状态,执行完后进行下面的检测ultrasonicdetect],没有触发就一直循环检测,触发就进入 autornatismstate2状态,执行完也不再回到下面的程序。


$ Y. Q8 O9 Q- {6 e- j# c1 ?

        3 、状态标志位Z、C的不同使用情况


  a- A! x/ m" \! G5 _

        在进行判断标志位时,Z(零标志)、C(借位标志)是不同的。Z为l时,表示上面的结果为0,Z为0时,则结果不为0。C为l时,借位,C为0时,没有借位。在使用定时器的时候,一般使用C标志位,这是由于当完成某一动作去检查定时器时,时间可能没到,或是正好,或是已经超过时间,只要到了或超过时间,都要按照要求关闭定时器,如下面程序所述。如果用Z标志位,等于0时可能没有检测到,无法判断停止的状态,而用z可以很好地控制时间定时。进行一般的计算时大多用Z,如前面的动作标志位中就是如此使用的。


) X. m2 M# u. m1 M  W' ~# ^/ a& A( B

        list D=16c76


' h% t0 R! E# Y/ |! k' E3 C# y

        call opentimerO


* p1 g% S- n! Z& r: S3 {2 ]

        L4 movlw d’30’


5 s3 X' r" t' i8 e

        subwf t0_v2,W

2 o# {+ }" @5 F5 Q" |

        btfss status,c


1 v  n. b+ C; k+ u

        goto L4


- f" j$ H& N6 [2 n% a

        cau closetimer0

+ z, H4 A3 k3 P: H

        程序检测时间是否到达1.5s,没有则循环等待,到了或检测时间过了就关闭定时器,执行下面的程序。

& ^1 p2 \: l0 \+ r2 s( D1 g9 V

        总之,在PIC单片机的编程中采用合适的方法,可以使整个程序运行稳定,而且程序空间的使用也将有所减小,避免了调试中的Bug。这是笔者在实际中的一点体会,还有许多不足或没有考虑到的问题,希望在和大家的探讨中不断学习PIC单片机的精髓。

收藏 评论1 发布时间:2020-3-26 14:25

举报

1个回答
lstkcsh 回答时间:2020-3-30 00:25:04
该用户从未签到
关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
STM32N6 AI生态系统
STM32MCU,MPU高性能GUI
ST ACEPACK电源模块
意法半导体生物传感器
STM32Cube扩展软件包
关注我们
st-img 微信公众号
st-img 手机版