Đề tài Thiết kế hệ thống điều khiển thang máy

nguyenvanbientbd47@gmail.com B¸o c¸o m«n häc M«n:ThiÕt kÕ m¹ch logic §Ò tµi: ThiÕt kÕ hÖ thèng ®iÒu khiÓn thang m¸y Môc lôc I. Giíi thiÖu……………………………………………………… .. 2 1. Giíi thiÖu ®Ò tµi 2 2. Giíi thiÖu kü thuËt sè………………………………………… … 2 II. ý tëng…………………………………………………………. . 3 1. Thùc tÕ……………………………….……………………… ….. 3 a. HÖ thèng thang m¸y thùc tÕ……………………………… …. 3 b. Ho¹t ®éng………………………………………………… .… 3 2. ý tëng……………………………………………………… ….. 3 III. giíi thiÖu linh kiÖn sö dông……………………………… 4 1. Cæng l«gic…………… …………… … …………… ………….. 4 2. IC gi¶i m·…………………………………………… ………….. 5 3. §Ìn LED………………………………………………………… 5 4. R¬le ®iÖn ¸p 5v……………………………………… …………. 5 5. Vi ®iÒu khiÓn AT89C51…………………………………………. 6 IV. m« t¶ chi tiÕt……………… . .……………………………….. 7 1 nguyenvanbientbd47@gmail.com A. S¬ ®å khèi hÖ thèng…………… . ……………………………… 7 B. ThiÕt kÕ ý tëng…………………………………………………. 7 1. Khèi yªu cÇu vµ b¸o tÇng……………………………………… 7 2. Khèi ®iÒu khiÓn Cabin vµ cöa………………………………… 9 3. Khèi chØ thÞ yªu cÇu…………………………………………… 9 4. Khèi chØ thÞ ho¹t ®éng………………………………………… 9 5. Khèi ®iÒu khiÓn trung t©m…………………………………… 10 a. Líp so s¸nh …………………………………… ..……… 10 b. Ho¹t ®éng hÖ thèng trong c¸c Mode. 10 c. Líp ®iÒu khiÓn chØ thÞ yªu cÇu………………… ………..11 6. Yªu cÇu mçi khèi……………………… ……….………….… 11 V. thiÕt kÕ m¹ch nguyªn lý………………………………… 11 1. M¹ch lËp m·……………………………………………………. 11 2. M¹ch hiÓn thÞ tÇng……………………………………… ……. 12 3. C¸c khèi ®iÒu khiÓn ho¹t ®éng………………………………… 12 4. Khèi ®iÒu khiÓn trung t©m…………………………….. … …… 12 VI. ch¬ng tr×nh ®iÒu khiÓn…………………………… …… 13 1. §å h×nh ch¬ng tr×nh…………………………………… .. …… 14 2. Ch¬ng tr×nh ®iÒu khiÓn…………………….…………………. 15 C¸c phô lôc. sau trang 15 2 nguyenvanbientbd47@gmail.com i. Giíi thiÖu 1. Giíi thiÖu ®Ò tµi Cïng víi sù ph¸t triÓn cña x· héi, nhµ cao tÇng ngµy cµng nhiÒu ®Ó phï hîp víi yªu cÇu cña cuéc sèng. Thang m¸y trë nªn rÊt quan träng vµ tiÖn lîi h¬n rÊt nhiÒu so víi cÇu thang bé.Thang m¸y gióp con ngêi tiÕt kiÖm thêi gian vµ søc lùc. HÖ thèng ®iÒu khiÓn thang m¸y rÊt phøc t¹p, nhÊt lµ ®èi víi kÜ thuËt t¬ng tù. Tuy nhiªn, víi sù ph¸t triÓn cña kÜ thuËt sè ®· gióp cho hÖ thèng ®iÒu khiÓn thang m¸y ®îc ®¬n gi¶n h¬n. Trong thùc tÕ, hÖ thèng ®iÒu khiÓn thang m¸y rÊt phøc t¹p cho nhiÒu kiÓu nhµ kh¸c nhau. Nhng víi m«n häc thiÕt kÕ m¹ch logic , môc ®Ých lµ tiÕp cËn víi viÖc øng dông kü thuËt sè vµo cuéc sèng nªn hÖ thèng ®îc thiÕt kÕ trong ®Ò tµi nµy lµ mét hÖ thèng ®iÒu khiÓn thang m¸y tèi ®a lµ chÝn tÇng ho¹t ®éng theo chÕ ®é taxi 2. Giíi thiÖu kü thuËt sè Kü thuËt sè (Digital) lµ mét kü thuËt míi trong nghiªn cøu vµ øng dông tÝn hiÖu ®iÖn. Nhng kh¸c víi kü thuËt t¬ng tù, nghÜa lµ víi tÝn hiÖu vµo vµ ra cã cïng d¹ng biÕn ®æi, kü thuËt sè lµ sù tæ hîp c¸c møc tÝn hiÖu ®Ó t¹o thµnh c¸c m·. Trong kü thuËt sè hiÖn ®¹i ngêi ta dïng hÖ sè nhÞ ph©n. Tuy kh«ng thÓ bá qua kü thuËt t¬ng tù nhng ta còng nhËn thÊy r»ng kü thuËt sè ®· ®em l¹i nhiÒu thµnh c«ng lín trong kü thuËt, d©n dông, vµ nhiÒu lÜnh vùc bªn ngoµi. 3 nguyenvanbientbd47@gmail.com II. ý tëng 1. Thùc tÕ a. HÖ thèng thang m¸y thùc tÕ gåm HÖ thèng ®iÒu khiÓn Cabin - HÖ thèng cöa - HÖ thèng yªu cÇu - HÖ thèng chØ thÞ yªu cÇu - B¸o hiÖu qu¸ t¶i - Bé ®iÒu khiÓn trung t©m - HÖ thèng cÊp th«ng tin vµ n¨ng lîng … b. Ho¹t ®éng Cabin lu«n ë chÕ ®é chê nghÜa lµ: - Khi Cabin ®ang trong chÕ ®é kh«ng t¶i (Kh«ng chuyÓn ®éng) th× Cabin lu«n chê chØ thÞ ngêi sö dông. Khi cã lÖnh tõ ngêi sö dông, hÖ thèng xö lý kiÓm tra vµ quyÕt ®Þnh ho¹t ®éng cho Cabin, hÖ thèng cña, hÖ thèng th«ng b¸o hay hÖ thèng b¸o ®éng. - Khi Cabin ®ang ho¹t ®éng nÕu ngêi sö dông ra chØ thÞ, bé ®iÒu khiÓn trung t©m sÏ nhËn tÝn hiÖu vµ kiÓm tra ho¹t ®éng hiÖn thêi vµ ho¹t ®éng yªu cÇu ®Ó ®a ra quÕt ®Þnh tiÕp tôc ho¹t ®éng hay ngõng ho¹t ®éng cña Cabin. 2. ý tëng ThiÕt kÕ 1 HÖ thèng ®iÒu khiÓn thang m¸y gåm: - HÖ thèng ®iÒu khiÓn Cabin - HÖ thèng cöa - HÖ thèng yªu cÇu ( chÕ ®é hiÓn thÞ tÇng ) - HÖ thèng chØ thÞ yªu cÇu - Khèi ®iÒu khiÓn trung t©m 4 nguyenvanbientbd47@gmail.com - HÖ thèng chØ thÞ ho¹t ®éng ( t¨ng lªn hoÆc gi¶m ) Ho¹t ®éng : lµm viÖc theo chÕ ®é taxi. Cã nghÜa lµ : Cabin cã thÓ lªn xuèng theo yªu cÇu nhng kh«ng chÊp nhËn ng¾t ho¹t ®éng hiÖn hµnh. HÖ thèng chØ nhËn lÖnh khi cã th«ng b¸o Cabin ®ang kh«ng lµm viÖc vµ bá qua tÊt c¶ c¸c yªu cÇu khi Cabin ®ang ho¹t ®éng. Khi Cabin kh«ng ho¹t ®éng hÖ thèng chÊp nhËn yªu cÇu. Th«ng tin vÒ tÇng ®ang hiÖn hµnh vµ th«ng tin vÒ tÇng yªu cÇu ®Õn ®îc lu l¹i vµ so s¸nh. NÕu chØ sè tÇng hiÖn hµnh lín h¬n chØ sè tÇng yªu cÇu ®Õn th× hÖ thèng ra tÝn hiÖu cho Cabin ®i xuèng. NÕu chØ sè tÇng hiÖn hµnh nhá h¬n chØ sè tÇng yªu cÇu ®Õn th× hÖ thèng ra tÝn hiÖu cho Cabin ®i lªn. NÕu hai chØ sè nµy b»ng nhau th× hÖ thèng cho cöa më, sau mét thêi gian ®Þnh tríc th× cho ®ãng l¹i vµ chê chØ thÞ tiÕp theo. Vµ trong qu¸ tr×nh vËn hµnh cña Cabin hÖ thèng lu«n lu l¹i hai chØ sè ®ã vµ Cabin chØ ngõng ho¹t ®éng khi hai chØ sè nµy b»ng nhau. III. Giíi thiÖu linh kiÖn sö dông 1. Cæng logic Trong thiÕt kÕ ta chØ sö dông cæng OR trong IC74LS32. IC74LS32 : lµ mét IC chøa 4 cæng or cã s¬ ®å ch©n nh sau: 5 D M 74 L S3 2 A1 B1 Y1 A2 B2 Y2 GND VCC A4 B4 Y4 A3 B3 Y3 nguyenvanbientbd47@gmail.com 2. IC gi¶i m· Trong thiÕt kÕ ®Ò tµi ta dïng IC gi¶i m· 74LS47 . IC74LS47 lµ IC gi¶i m· cho ®Ìn LED 7 thanh víi ®Çu vµo m· BCD vµ ®Çu ra lµ 7 ®Çu ®a vµo 7 ch©n cña LED 7 thanh. 3. §Ìn LED 4. R¬le ho¹t ®éng ®iÖn ¸p 5V Lµ lo¹i R¬le dïng ®ãng ng¾t m¹ch b»ng dßng 5V . Khi cã dßng 5V mét m¹ch tõ ®îc ®ãng l¹i . V× vËy ta cã thÓ dïng lo¹i R¬le nµy ®Ó ®ãng c¸c m¹ch dung nguån lín h¬n 5V 6 74LS47 VCC f g a b c d e B C D A GND Ch©n - + LED ®¬n g f 5v a b e d c LED 7 thanh RY5W-K 1 2 3 4 8 7 6 5 nguyenvanbientbd47@gmail.com Ch©n 1, 8 : lµ hai ch©n ®iÒu khiÓn, khi cã hiÖu ®iÖn thÕ 5v trªn hai ®Çu ch©n nµy th× m¹ch tõ ®îc ®ãng. Ch©n 2, 3, 4 : khi m¹ch tõ ®îc ®ãng th× hai ch©n 2, 4 ®îc nèi, con khi m¹ch .tõ më th× 3, 4 ®îc nèi Ch©n 5, 6, 7 : khi m¹ch tõ ®îc ®ãng th× hai ch©n 5, 7 ®îc nèi, con khi m¹ch tõ më th× 5, 6 ®îc nèi. 5. Vi ®iÒu khiÓn A89C51 §©y lµ IC vi ®iÒu khiÓn (Micro Controller) ho¹t ®éng theo ch¬ng tr×nh lËp tr×nh tríc. IC nµy cã 3 Port cã thÓ vµo ra d÷ liÖu digital (c¸c tÝn hiÖu ®iÖn 5v,0v). Ch¬ng tr×nh lËp tr×nh tríc ®îc ®a vµo ROM cña IC nµy. Vµ ta cã thÓ lËp tr×nh cho ROM ho¹t ®éng nh mét m¹ch sè häc b×nh thêng víi ®Çy ®ñ c¸c chøc n¨ng. Ch¬ng tr×nh dµnh cho ®Ò tµi nµy n»m trong phÇn cuèi b¸o c¸o. 7 P1.0 P1.1 P1.2 P1.3 P1.4 P1.5 P1.6 P1.7 P3.0 P3.1 P3.2 P3.3 P3.4 P3.5 P3.6 P3.7 XTAL2 XTAL1 GND VCC P0.0 P0.1 P0.2 P0.3 P0.4 P0.5 P0.6 P0.7 EA/VPP ALE PSEN P2.0 P2.1 P2.2 P2.3 P2.4 P2.5 P2.6 P2.7 1 40 2 39 3 38 4 37 5 36 6 35 7 34 8 33 9 32 10 31 11 30 12 29 13 28 14 27 15 26 16 25 17 24 18 23 19 22 20 21 nguyenvanbientbd47@gmail.com IV. M« t¶ chi tiÕt A. S¬ ®å khèi HÖ thèng ®iÒu khiÓn thang m¸y B. ThiÕt kÕ ý tëng 1. Khèi yªu cÇu vµ b¸o tÇng Hai khèi nµy cã nguyªn t¾c ho¹t ®éng vµ cÊu t¹o t¬ng tù nhau. 8 Khèi bµn phÝm Khèi ®iÒu khiÓn trung t©m Khèi hiÓn thÞ tÇng Khèi b¸o tÇng Khèi ®iÒu khiÓn Motor ChØ thÞ ho¹t ®éng H×NH 1 : S¥ §å KhèI HÖ THèNG §IÒU KHIÓN THANG M¸Y H×nh 2: S¬ ®å khèi gi¶i m· Bé lËp m· I 1 I 2 I 3 I 4 I 5 I 6 I 7 I 8 9 ®Çu vµo M· BCD ®­îc lËp A B C D nguyenvanbientbd47@gmail.com §©y lµ 1 m¹ch logic gåm 9 ®Çu vµo tÝch cùc møc cao va 4 ®Çu ra díi d¹ng m· BCD cã thÓ gäi ®©y lµ 1 khèi lËp m· BCD. Sè Gi¸ trÞ ®Çu vµo Gi¸ trÞ ®Çu ra V1 V2 V3 V4 V5 V6 V7 V8 V9 D C B A 1 1 0 0 0 0 0 0 0 0 0 0 0 1 2 0 1 0 0 0 0 0 0 0 0 0 1 0 3 0 0 1 0 0 0 0 0 0 0 0 1 1 4 0 0 0 1 0 0 0 0 0 0 1 0 0 5 0 0 0 0 1 0 0 0 0 0 1 0 1 6 0 0 0 0 0 1 0 0 0 0 1 1 0 7 0 0 0 0 0 0 1 0 0 0 1 1 1 8 0 0 0 0 0 0 0 1 0 1 0 0 0 9 0 0 0 0 0 0 0 0 1 1 0 0 1 B¶ng ch©n lý bé gi¶i m· §Çu ra ta chØ chÊp nhËn m· tõ 0000  1001. Nh vËy trong bé nµy ta kh«ng chÊp nhËn gi¸ trÞ V=1 cung lóc v× nh vËy sÏ t¹o ra 1 m· kh¸c. Sù kh¸c nhau gi÷a khèi yªu cÇu vµ khèi b¸o tÇng: - Trong khèi yªu cÇu: §Çu vµo gi¶i m· (9 ch©n) cña khèi ®îc nèi víi 1 bµn phÝm chÝn nót. Bµn phÝm ®îc thiÕt kÕ sao cho khi 1 phÝm ®îc nhÊn  gi¸ trÞ ®Çu vµo bé gi¶i m· cã tªn øng víi gi¸ trÞ trªn phÝm lµ møc “H”(=1). TÊt c¶ c¸c ®Çu cßn l¹i = 0, nÕu kh«ng cã phÝm ®îc nhÊn th× tÊt c¶ c¸c ®Çu = “L”(=0) - Trong khèi b¸o tÇng: 9 ®Çu vµo m¹ch gi¶i m· ®îc nèi víi 9 ®Çu vµo chuyÓn m¹ch dïng theo nguyªn t¾c c¬ häc. (Khi cabin tíi mét tÇng th× ®Çu vµo tÇng ®ã ®îc øng víi møc logic “1” cßn tÊt c¶ c¸c ®Çu cßn l¹i b»ng “0”) - Trong thùc tÕ ngêi ta dïng chuyÓn m¹ch tõ. Trong ®Ò tµi nµy ta dïng chuyÓn m¹ch c¬ khÝ (tiÕp xóc kim lo¹i). 2. Khèi ®iÒu khiÓn cabin vµ më cöa 9 nguyenvanbientbd47@gmail.com Dïng hai tÝn hiÖu ®Ó ®iÒu khiÓn chiÒu quay cña motor 1 chiÒu 16 v«n ®iÖn ¸p. Mét tÝn hiÖu ®iÒn khiÓn quay thuËn, 1 tÝn hiÖu ®iÒu khiÓn quay ngîc. Hai tÝn hiÖu nµy kh«ng bao giê ®ång thêi ë møc cao. Ta dïng 2 r¬le 5V ®ãng m¹ch tèi ®a 30V. Mét r¬le nhËn tÝn hiÖu ®Ó ®iÒu khiÓn quay thuËn, 1 r¬le nhËn tÝn hiÖu ®Ó ®iÒu khiÓn quay ngîc. TÝn hiÖu ®iÒu khiÓn hai motor nµy lÊy trùc tiÕp tõ vi xö lý  sö dông 4 bit trong 1 Port cña Vi xö lý . Ta lËp tr×nh vi xö lý ®Ó hai motor kh«ng ho¹t ®éng cïng mét lóc. Khi cabin ®ang chuyÓn ®éng th× cöa kh«ng më vµ ngîc l¹i . 3. Khèi chØ thÞ yªu cÇu : gåm 2 LED 7 thanh Môc ®Ých : Th«ng b¸o cho ngêi sö dông biÕt cabin tÇng yªu cÇu ®Õn vµ tÇng hiÖn t¹i. Trong trêng hîp cabin ®øng yªn, c¶ 2 LED 7 thanh ®Òu hiÓn thÞ sè thø tù tÇng hiÖn t¹i. Ta ®a m· tõ khèi ®iÒu khiÓn trung t©m qua mét bé gi¶i m· tíi LED 7 thanh 4. Khèi chØ thÞ ho¹t ®éng Gåm 4 LED chØ thÞ tr¹ng th¸i ho¹t ®éng cña cabin. Trong mét thêi ®iÓm bÊt kú chØ duy nhÊt mét ®Ìn s¸ng . §Ìn 1 : Th«ng b¸o cabin ®ang lªn. §Ìn 2 : Th«ng b¸o cabin ®ang xuèng . §Ìn 3 : Th«ng b¸o cöa cabin ®ang më . §Ìn 4 : Th«ng b¸o cabin nghØ . 4 LED ®îc ®iÒu khiÓn bëi 4 bit trong port 2 tõ khèi ®iÒu khiÓn trung t©m . B¶ng tr¹ng th¸i ho¹t ®éng Tr¹ng th¸i ho¹t ®éng §Ìn b¸o lªn §Ìn b¸o xuèng §Ìn b¸o nghØ §Ìn b¸o më cña Cacbin lªn 1 0 0 0 Cabin xuèng 0 1 0 0 Cabin nghØ 0 0 1 0 Më cöa 0 0 0 1 10 nguyenvanbientbd47@gmail.com 5. Khèi ®iÒu khiÓn trung t©m a. Líp so s¸nh Lµ mét bé so s¸nh 4 bit (8 ®Çu vµo) A vµ B cã 3 ®Çu ra A > B  ®Çu ra 1 = “1” , ®Çu ra 2,3 = “0” -> Mode 1 A = B  ®Çu ra 2 = “1” , ®Çu ra 1,3 = “0” -> Mode 2 A Mode 3 3 ®Çu ra nµy sÏ ®iÒu khiÓn ho¹t ®éng khèi c¬ khÝ nh sau: b. Ho¹t ®éng hÖ thèng trong c¸c mode - Mode1 : Thang m¸y lªn tíi khi co b¸o hiÖu tÇng ®ang qua trïng tÇng cÇn ®Õn. - Mode2 : Thang m¸y xuèng tíi khi co b¸o hiÖu tÇng ®ang qua trïng tÇng cÇn ®Õn. - Mode3 : Cöa më .  §iÒu khiÓn ho¹t ®éng líp ®iÒu khiÓn chØ thÞ ho¹t ®éng 11 M· BCD tõ: bµn phÝm A cabin B HiÓn thÞ: TÇng hiÖn hµnh TÇng yªu cÇu Líp so s¸nh 4 bÝt Líp nhËn lÖnh vµ thi hµnh Líp hiÓn thÞ ho¹t ®éng Líp hiÓn thÞ ®iÒu khiÓn chØ thÞ M« t¶ ho¹t ®éng cña khèi ®iÒu khiÓn trung t©m nguyenvanbientbd47@gmail.com c. Líp ®iÒu khiÓn thÞ yªu cÇu NhËn trùc tiÕp m· tõ bµn phÝm vµ cabin ®Ó ®a ra LED 7 thanh . 6. Yªu cÇu mçi khèi Ph¶i lu ®îc tr¹ng th¸i cò tríc khi tr¹ng th¸i míi ®îc x¸c lËp : Víi c¸c IC sè häc b×nh thêng (Automat cã nhí vµ kh«ng nhí) ta sö dông viÖc lu tr¹ng th¸i b»ng c¸c Flip-Flop. Víi kü thuËt Vi xö lý ta dïng c¸c thanh ghi. v. thiÕt kÕ m¹ch nguyªn lý 1. M¹ch l©p m· Tõ ph©n tÝch trong phÇn IV/1 vµ b¶ng ch©n lý ta cã: A = V1+V3+V5+V7+V9 B = V2+V3+V6+V7 C = V4+V5+V6+V7 D =V8+V9 V× vËy ta ®a ra m¹ch sau: 1 2 3 9 10 8 1 2 3 D 12 13 11 C12 13 11 1 2 3 9 10 8 B 4 5 6 12 13 11 4 5 6 v1 v2 v3 v4 v5 v6 v7 v8 v9 A 12 M¹ch lËp m· BCD 9 ®Çu vµo nguyenvanbientbd47@gmail.com 2. M¹ch hiÓn thÞ tÇng M¹ch hiÓn thÞ tÇng hiÖn hµnh còng nh tÇng cÇn ®Õn lµ t¬ng ®¬ng, chØ kh¸c lµ ®Çu vµo m¹ch hiÓn thi tÇng yªu cÇu ®Õn nhËn tÝn hiÖu tõ 4 bit cao cña Port 2 cßn m¹ch hiÓn thi tÇng hiÖn hµnh nhËn tÝn hiÖu tõ c¸c bit cßn l¹i cña Port 2. 4 Bi t Po rt 2 74LS47 7 1 2 6 4 5 3 13 12 11 10 9 15 14 D0 D1 D2 D3 BI/RBO RBI LT A B C D E F G c . d e g f vc c a b 3. C¸c khèi ®iÒu khiÓn ho¹t ®éng Nh ®· nãi phÇn trªn ta dïng hai tÝn hiÖu ®Ó ®iÒu khiÓn ho¹t ®éng cña c¸c motor (Motor Cabin còng nh Motor cöa) M¹ch ®iÒu khiÓn ®îc thiÕt kÕ nh sau: 4. Khèi ®iÒu khiÓn trung t©m (Xem s¬ ®å toµn hÖ thèng trong phô lôc) 13 16vDC ThuËn Ng­îc 16vD Motor R¬le R¬le M¹ch ®iÒu khiÓn Motor Mạch giải mã BCD -> LED 7 thanh nguyenvanbientbd47@gmail.com VI. Ch¬ng tr×nh ®iÒu khiÓn 1. §å h×nh ch¬ng tr×nh 14 Start B¸o tr¹ng th¸i nghØ KiÓm tra phÝm bÊm A=B M· phÝm vµo A M· Cabin vµo B Cã bÊm Më cöa §ãng cöa End A<B §i lªn §i xuèng ®óng sai Sai ®óng ®óng Sai L­u ®å khèi cña ch­¬ng tr×nh ®iÒu khiÓn Cho ra hiÓn thÞ M· Cabin vµo B Cho ra hiển thÞ M· Cabin vµo B Cho ra hiển thÞ Cho ra hiển thÞ nguyenvanbientbd47@gmail.com 2. Ch¬ng tr×nh ®iÒu khiÓn Dßng 1 $DEBUG 2 $NOPAGING 3 $NOSYMBOLS 4 ; FILE : THANGMAY. SCR 5 ;********************************************************** 6 ; CHUONG TRINH CHO DIEU KHIEN THANG MAY 7 ;********************************************************** 8 MAIN : CALL IN_bcd ; NhËp m· tõ bµn phÝm 9 JC action ; Cho ho¹t ®éng 10 sjmp main ; lÆp l¹i 11 ;********************************************************** 12 ;in_bcd : NhËp m· sè lµ m· BCD tõ bµn phÝm cã chèng nÈyphÝm khi Ên 13 ;vµ khi nh¶ ( lÆp l¹i cho 50 lÇn mçi khi Ên hoÆc nh¶ ) 14 ;********************************************************** 15 in_bcd : mov r3,#50 ; sè ®Õm chèng nÈy 15 nguyenvanbientbd47@gmail.com 16 back : call get_key ; gäi tr×nh nhËn phÝm 17 jnc in_bcd ; nÕu cê nhí=0 nhÈy 18 djnz r3, back ;gi¶m nhÈy tíi khi R3=0 19 push acc ; cÊt vµo stack 20 back2 : mov r3 , #50 ; sè ®Õm lµ 50 21 back3 : call get_key ; goi tr×nh nhËn phÝm 22 jc back2 ; cê C=0 nhÈy 23 djnz r3 , back3 ; r3 kh¸c 0 nhÈy 24 pop acc ; lÊy ra khái stack 25 ret ; kÕt thóc 26 get_key : mov a , P0 ; ®a p0 vµo a 27 anl a , #f0h ; lÊy phÇn cao 28 swap a ; quay a 29 cjne a, #00h , done ; nÕu A kh¸c 0 done 30 clr c ; xãa cê nhí 31 sjmp exit ; tho¸t 32 done : setb c ; ®äc ®îc phÝm víi C=1 33 exit : ret ; kÕt thóc tr×nh con 34 ;********************************************************** 35 ; nh vËy ta ®· cã m· bµn phÝm trong A m· Cabin trong B 36 ;********************************************************** 37 ;********************************************************** 38 ;action : Tr×nh con ®iÒu khiÓn ho¹t ®éng cho toµn hÖ thèng 39 ;chøc n¨ng : so s¸nh hai gi¸ trÞ trong hai thanh ghi A vµ B ®Ó ®a ra 40 ;ho¹t ®éng 41 ;********************************************************** 42 action : mov r6 , a ; đa m·bµnphÝmvµo R6 43 mov b , r6 ; đa m· bµn phÝm vµo B 44 mov a , p0 ; đa P0 vµo a 45 anl a , #0f ; chØ lÊy m· cabin 46 cjne a , b , up_down ; so s¸nh m· cabin vµ 47 sjmp mocua ; bµn phÝm, b»ng nhau th× 48 ljmp esc ; më cöa, kh¸c lªn xuèng 49 ;********************************************************** 50 ; Tr×nh con më cña khi nhËn kÕt qu¶ b»ng trong phÐp so s¸nh m· bµn 16 nguyenvanbientbd47@gmail.com 51 ;phÝm vµ m· Cabin 52 ; ********************************************************** 53 mocua : mov r5 , a ; ®a m· Cabin vµo r5 54 mov a , b ; đa m· phÝm vµo a 55 swap a ; quay m· phÝm 56 orl a , r5 ;Hîp m· phÝm vµ m· cabin 57 mov p2, a ; đa a ra port 2 58 mov p1 , #00010010b ; đa ra p1 lÖnh më cöa 59 mov r5 , #0ffh ; cho sè ®Õm 60 wait1 : djnz r5 , wait1 ; đÕm r5 61 mov p1 , #00000010b ; t¹m dõng chê vµo 62 mov r5 , #0ffh ; cho sè ®Õm 63 wait2 : djnz r5 , wait2 ; đÕm R5 64 mov p1 , #00100010b ; t¹m dõng chê ®ãng 65 mov r5 , #0ffh ; cho sè ®Õm 66 wait3 : djnz r5 , wait3 ; đÕm R5 67 sjmp esc ; tho¸t 68 ;********************************************************** 69 ; Tr×nh con ®iÒu khiÓn lªn xuèng khi nhËn kÕt qu¶ kh«ng b»ng trong 70 ;phÐp so s¸nh m· bµn phÝm vµ m· Cabin 71 ; ********************************************************** 72 Up_down : jc down ; cê nhí b»ng 1 down 73 Sjmp up ; b»ng 0 up 74 ;********************************************************** 75 ; Tr×nh con ®iÒu khiÓn xuèng khi nhËn kÕt qu¶ kÐm trong phÐp so s¸nh 76 ; m· bµn phÝm vµ m· Cabin 77 ;********************************************************** 78 down : mov p1 , #01000100b ; cho lÖnh xuèng 79 mov r6 , a ; cho m·cabin vµo r6 80 mov a , b ; cho m· phÝm vµo a 81 swap a ; quay a 82 orl a , r6 ; Hîp hai m· 83 mov p1 , A ; đa hai m· ra hiÓn thÞ 84 sjmp action ; quay vÒ action 85 ; ********************************************************** 86 ; Tr×nh con ®iÒu khiÓn xuèng khi nhËn kÕt qu¶ kÐm trong phÐp so s¸nh 17 nguyenvanbientbd47@gmail.com 87 ; m· bµn phÝm vµ m· Cabin 88 ;********************************************************** 89 up : mov p1 , #10001000b ; ®a ra chØ thÞ lªn 90 mov r6 , a ; cho m·cabin vµo r6 mov a , b ; cho m· phÝm vµo a 91 swap a ; quay a 92 orl a , r6 ; hîp hai m· 93 mov p1 , A ; đa hai m· ra hiÓn thÞ 94 sjmp action ; trë vÒ action 95 ;********************************************************** 96 ; Tr×nh con hç trî tho¸t 97 ;********************************************************** 98 sc : ret ; tho¸t ch¬ng tr×nh con 18