Středoškolská odborná činnost 2006/2007 Obor 12 – Tvorba učebních pomůcek, didaktická technologie
Modelový řídící systém pro ovládání technolog. procesu – portálový jeřáb
Autor: Jiří Pénzeš SPŠ Trutnov, Školní 101 541 01 Trutnov, 3.ročník Konzultant práce: Ing. Petr Velech SPŠ Trutnov, Školní 101 541 01 Trutnov
Trutnov, 2007 Královehradecký kraj
2 Jiří Pénzeš Tovární 598 Trutnov 4
Anotace Práce se zabývá realizací skutečného modelu technologického zařízení. Uvedeným zařízením je model portálového jeřábu, který je sestaven ze známé stavebnice Merkur. Předložená práce řeší vlastní hardware pro ovládání daného zařízení včetně několika způsobů komunikace mezi řidícím PC a hardwarem tohoto zařízení. Součástí je dále počítačový program v Control Web, který celé zařízení ovládá a poskytuje přehlednou vizualizaci při ovládání.
V Trutnově dne 7. února 2007
3
Tímto prohlašuji, že jsem soutěžní práci vypracoval samostatně pod vedením Ing. Petra Velecha a uvedl v seznamu literatury veškerou použitou literaturu a další informační zdroje včetně internetu.
V Trutnově dne 7.2.2007
………………………. podpis autora
4
Obsah Úvod: .......................................................................................................................................... 5 Komunikace: .............................................................................................................................. 5 Návrh způsobu komunikace (protokol).................................................................................. 5 Volba typu sběrnice pro komunikaci ..................................................................................... 6 Hardware: ................................................................................................................................... 7 Úprava dodaných motorků stavebnice Merkur, elektronické řízení ...................................... 7 Návrh způsobu snímání polohy natočení hřídele ................................................................... 8 Řídící jednotka pro obsluhu komunikace a pohonu (uP 8051) .............................................. 9 Software: .................................................................................................................................... 9 Program řídící jednotky v asembleru ..................................................................................... 9 Vlastní program v prostředí Control Web 5, vizualizace..................................................... 12 Přílohy: ..................................................................................................................................... 14 Fotografie ............................................................................................................................. 14 Výpis programu řídící jednotky ........................................................................................... 16 Výpis programu v Control Web 5 ........................................................................................ 23
5
Úvod: U příležitosti Krkonošské hospodářské výstavy naše škola navázala spolupráci s firmou Merkur Police n/M., která vyrábí známou stejnojmennou stavebnici Merkur. Z této stavebnice bylo postaveno několik modelů. Jedním z modelů byl i portálový jeřáb, který byl vybaven motorky pro pohon ve všech třech osách ovládaný tlačítky bez jakékoliv elektroniky a koncových snímačů. Tento model mě velice zaujal a rozhodl jsem se ho upravit a využít jako výukovou pomůcku v programování a automatizaci. Ve škole při výuce programování a následně i při cvičení z automatizace používáme prostředí Contrel Web 5 a řízení tohoto modelu jeřábu pomocí počítače PC může být pro studenty velice atraktivní.
Komunikace: Aby bylo možné model jeřábu řídit a ovládat, je zapotřebí si mezi PC a modelem předávat informace. Je velice důležité zvolit vhodný způsob komunikace. Řídící PC musí elektronice modelu předávat informace o požadované poloze, kam se má hák jeřábu přesunout, případně i další řídící signály a naopak model musí PC informovat o skutečné poloze, aby tento mohl získané informace zpracovat. První myšlenka k realizaci komunikace byla použít zásuvnou kartu ADICOM, kterou máme k dispozici, a veškeré signály zpracovávat pouze programem v PC. Již při prvotním návrhu způsobu řízení, založeném na kartě ADICOM, jsem zjistil, že ovládání jeřábu tímto způsobem by bylo velmi obtížné a pro mě snad ani nerealizovatelné. Protože se v předmětu MIT (mikroprocesorová technika) věnujeme jednočipovému mikroprocesoru 8051, rozhodl jsem se po konzultaci s vyučujícím použít komunikaci založenou právě na tomto obvodu. Ukázalo se, že to byla velice šťastná volba. V případě použití karty ADICOM by kromě jiného k modelu vedlo velké množství vodičů, celé zařízení by se stalo molochem, musela by být minimální vzdálenost mezi kartou a modelem. Řešení na bázi obvodu 8051 otevírá v případě přenosu dat, ale i ovládání pohonů fantastické možnosti. Přenos lze realizovat od sériové linky RS232, přes USB až k bezdrátovému přenosu dat. Obvod 8051 má přímo v sobě oboustrannou sériovou linku USART.
Návrh způsobu komunikace (protokol) Funkce portálového jeřábu je naprosto jasná. Pomocí pohonů ve třech osách musíme lidově řečeno „dostat“ hák jeřábu na požadované místo. Protože však pohony jeřábu bude řídit PC musíme navrhnout a zvolit, co si jeřáb s PC budou vlastně „povídat“. Vzájemný způsob dorozumívání mezi jednotlivými zařízeními se nazývá komunikační protokol. K tomu, než vůbec můžeme tento protokol začít vytvářet je důležité přesně definovat co jaké zařízení bude obstarávat „dělat“. Zařízení PC Řídící jednotka uP 8051 elektronika
Funkce Vizualizace, přijímat skutečnou polohu, vysílat požadovanou polohu Snímat a vysílat skut. polohu, přijímat požadavek a na základě rozdílu ovládat budiče motorů (pohonů), nastavení výchozí polohy (kalibrace) Změna otáčení motorů (pohonů), optické snímaní polohy hřídele, koncáky
Z funkce portálového jeřábu je jasné, že řídící PC musí jeřábu říci, kam se má hák jeřábu přesunout. Dále je zapotřebí, čas od času a hlavně při zapnutí zařízení hák jeřábu
6 přesunout do výchozí (kalibrační) polohy. Poloha háku jeřábu je vlastně dána polohou natočení hřídele jednotlivých pohonů, a vlivem prokluzu né skutečnou absolutní polohou, která se i při mírném prokluzování a pojezdu sem a tam může podstatně lišit. Tato metoda ovládání je založena na přírůstcích (nazývá se inkrementální) od výchozího známého bodu. V našem případě jsou těmito výchozími body koncové snímače v jednotlivých osách pohybu. Tuto metodu používá velké množství zařízení (tiskárny, plottery, scannery, CNC stroje atd.). První návrh komunikačního protokolu obsahoval hodnoty v osách X, Y a Z a dále řídící signál na požadavek kalibrace. V průběhu realizace se však protokol zjednodušil pouze na hodnoty v ose X, Y a Z. Požadavek na kalibraci se nakonec stal zbytečný, a ke kalibraci dojde v jednotlivých osách vždy, když je příslušná hodnota osy X, Y nebo Z nulová. Protože byl s ohledem na Control Web 5 nakonec zvolen přenos pomocí RS232, byl vytvořen následující protokol. Pro přenos hodnot bylo s rezervou zvoleno 12-ti bitové číslo (hodnoty 0 až 4095) v každé ose v obou směrech. To znamená, že přenos dat je pro příjem i vysílání stejný. Aby nedocházelo ke kolizi při přenosu hodnot odpovídajících řídícím znakům, a hlavně přenosu hodnoty 00H, je pro každé čtyři bity použit jeden znak (byte). Každý přenášený znak (byte) je tedy tvořen tak, že vyšší čtyři bity vždy obsahují hodnotu 3H a nižší čtyři bity obsahují odpovídající čtveřici bitů přenášené hodnoty. Protože je přenášena 12-ti bitová hodnota pro každou osu, je zapotřebí odeslat celkem 36 bitů. Daným způsobem to odpovídá přenosu 9-ti znaků. Ovladač sériového portu implementovaný v Control Web 5 však pro ukončení přenosu vyžaduje povinně dva řídící znaky CR LF. Proto je komunikace uskutečňována pomocí celkem 11-ti znaků (včetně CR LF). Znaky (byty) jsou tedy přenášeny v následujícím pořadí: 3 x byte pro osu X, 3 x byte pro osu Y, 3 x byte pro osu Z a nakonec znaky CR LF. Tvar přenášených znaků (bytů) pro hodnotu v jedné ose: 0 0 1 1 b11 b10 b9 b8 0 0 1 1 b7 b6 b5 b4 0 3xH 3xH Celkový komunikační protokol: Osa X Osa Y b11- b8 b7- b4 b3- b0 b11- b8 b7- b4 b3- b0 3xH 3xH 3xH 3xH 3xH 3xH b0 – b11: jednotlivé bity 12-ti bitové hodnoty x: odpovídající hodnota příslušných čtyř bitů
b11- b8 3xH
Osa Z b 7- b 4 3xH
0
1
b 3- b 0 3xH
1 b3 b2 b1 b0 3xH
CR
LF
13H
10H
Uvedený způsob komunikace je kompromisem, který umožňuje poměrně snadné zpracování na obou stranách. To znamená jak na straně PC, tak i na straně řídící jednotky.
Volba typu sběrnice pro komunikaci Pro fyzické propojení PC s řídící jednotkou bylo zvoleno sériové rozhraní RS232, které je stále poměrně rozšířené u běžných PC. V současné době se samozřejmě nabízejí i další možnosti přenosu. Jednou z možností je využití dnes velice rozšířeného USB portu nebo pomocí bezdrátového spojení pomocí modulů 499,33MHz. Tyto moduly sice mají malou přenosovou rychlost, ale pro naši aplikaci to není kritické. Rozhraní RS232 je plně duplexní (umí nezávisle na sobě vysílat i přijímat současně) UART, což znamená univerzální asynchronní přijímač a vysílač. Vzhledem k tomu, že procesory 8051 již v sobě obsahují duplexní USART (univerzální synchronní i asynchronní přijímač a vysílač) lze obě zařízení vzájemně propojit. Jediným problémem je rozdílnost logických napěťových hladin (nejsou kompatibilní), což za nás vyřeší k tomu určené obvody např. MAX232.
7 Asynchronní přenos je založen na vysílání řídících signálu na jednom datovém vodiči společně s daty. Jedná se o řídící signály START a STOP bit. Tyto signály jsou v negaci a po zachycení signálu START bit se nastaví obvody přijímače pro příjem a přijímá jednotlivé datové bity. Po ukončení vysílání je na linku poslán signál STOP bit, přijímač ukončí příjem a přijímací obvody čekají na příchod dalšího řídícího signálu START bit. Celý děj se neustále opakuje. Pro asynchronní (samozřejmě i synchronní) přenos je nezbytně nutné, aby vysílač i přijímač byly nastaveny shodně a na stejnou přenosovou rychlost. Protože obě zařízení, jak PC, tak i řídící jednotka disponují obvody UART není realizace přenosu obtížná. Pouze, jak již bylo uvedeno, se musí obě zařízení nastavit shodně včetně přenosové rychlosti.
Hardware: Velká část této práce je věnovaná úpravám, které jsou nezbytné pro elektronické řízení jeřábu. Úpravy jeřábu spočívají především v upevnění vhodných koncových snímačů do krajních poloh tak, aby byla možná kalibrace a nemohlo dojít ke kolizi. Dále vyřešit řízení motorků a zvolit vhodný způsob snímání polohy hřídele.
Úprava dodaných motorků stavebnice Merkur, elektronické řízení Ke stavebnici Merkur jsou dodávány vlastně pohony, součástí kterých je i převodovka s možností volby jednoho ze dvou převodů. Pohony jsou poháněny běžnými stejnosměrnými motorky, u kterých se změna směru otáčení provádí změnou polarity napájení. Změnu polarity napájení je možné realizovat pomocí relé nebo samozřejmě elektronicky. Já jsem se rozhodl pro elektronické řešení řízení směru otáčení. V podstatě se jedná o běžný H-můstek, kde jsou dvě shodné větve tvořené komplementárními tranzistory, přičemž ve vodivém stavu je vždy pouze jeden tranzistor v závislosti na hodnotě řídícího signálu. Vývody motorku jsou zapojeny do středu obou větví a v závislosti na hodnotě logických signálů motorek buď stojí nebo je napájen v jednom nebo druhém směru. Každý motorek musí mít vlastní H-můstek. V případě pohonu jeřábu je tedy nutno mít tři H-můstky. Na obrázku je schéma zapojení a návrh plošného spoje.
8
Návrh způsobu snímání polohy natočení hřídele Poměrně mechanicky náročný úkol je snímání polohy hřídele. Při otáčení hřídele je nutno mít informaci o směru otáčení i úhlu natočení. Stavebnice Merkur obsahuje kruhovou součást, která je určena pro nasazení na hřídel a po obvodu jsou rovnoměrně rozmístěny otvory. Rozhodl jsem se tuto součást a optickou závoru využít pro snímání polohy. Jedná se o jednoduchý princip, jaký se používá například u klasické kuličkové myši k PC. Podmínkou pro správné snímání jsou dvě světelné závory, které musí být vzájemně pootočeny tak, aby výsledné signály byly fázově posunuty přibližně o úhel 45°.
Signál: A
B
Při vyhodnocení takto posunutých signálů je jeden inkrementální a druhý řídící, ze kterého lze určit směr otáčení (inkrementace nebo dekrementace). V případě, že signál A je inkrementální, tak každá změna jeho logické hodnoty inkrementuje (zvyšuje) nebo dekrementuje (snižuje) čítač polohy, a to v závislosti na logické hodnotě signálu B. Jdeme-li zleva, pak každá změna je reprezentována stejnou logickou hodnotou obou signálů. Naopak jdeme-li zprava, pak je každá změna reprezentována vzájemnou negací obou signálů. Řídící program pak na základě shody nebo negace těchto signálů inkrementuje nebo dekrementuje odpovídající proměnnou. Součást Merkuru, kterou jsem použil pro snímání polohy má rovnoměrně po obvodu otvory o průměru 4 mm a rozteč otvorů je 8 mm. Pro získání odpovídajícího signálu je zapotřebí umístit optozávory 6 mm od sebe pokud možno do osy otvorů. Schéma zapojení snímače a deska s plošnými spoji je na následujícím obrázku.
Ačkoliv jsem si pohon, který má být opatřen snímačem polohy poctivě poměřil a plošný spoj nechal vyrobit přesně fotocestou, nepodařilo se mi optozávory umístit tak, abych získal požadované signály. Několikrát jsem optické prvky přepajoval, ale výsledné signály nebylo možné využít ke snímání polohy. Příčinou jistě bylo ruční pájení optických prvků, ale taky zřejmě přispěl fakt, že pohon Merkuru byl vyosen a značně házel. Nakonec nezbylo nic jiného, než součást Merkuru značně mechanicky upravit, čímž se samozřejmě zmenšila
9 citlivost snímače. Úprava je zřejmá z fotodokumentace. Po této úpravě byly výsledné signály naprosto v pořádku.
Původní signál od snímače polohy
Signál po úpravě a snížení citlivosti
Vzhledem k použitým optočlenům, hlavně jejich charakteristice, již není potřeba výstupní signály snímače polohy nijak upravovat a lze je přímo připojit k vstupně/výstupním portům řídící jednotky.
Řídící jednotka pro obsluhu komunikace a pohonu (uP 8051) Jako řídící jednotku lze použít libovolný obvod řady 8051 v základním zapojení s převodníkem TTL/RS232 nutným pro přizpůsobení napěťové úrovně logických signálů. Já jsem jako řídící jednotku použil hotový kit, který je využíván ve výuce při praktických cvičeních. Aby komunikace, a samozřejmě i obslužný program v PC byly co nejjednodušší, ovládá řídící jednotka jeřáb úplně samostatně bez nutnosti vnějšího zásahu. Princip spočívá v tom, že PC po sériové lince dle stanoveného protokolu pošle řídící jednotce hodnoty, kam se má hák jeřábu posunout a řídící jednotka již samostatně ovládá pohony a kontroluje správnost polohy, přičemž samozřejmě vyhodnocuje stav koncových snímačů. Na druhou stranu řídící jednotka opět na základě stanoveného protokolu posílá do PC aktuální (v reálném čase) polohu háku jeřábu.
Software: Program řídící jednotky v asembleru Nejdůležitější část modelu jeřábu je obslužný program řídící jednotky. Program je uložen přímo v paměti FLASH procesoru 8051. Protože program ošetřuje přímo jednotlivé bity vstupně/výstupních portů, a samozřejmě proto, že škola má vývojové prostředí pro tyto obvody, je program napsán v Asembleru 51. Struktura programu řídící jednotky je přehledně znázorněna v přiloženém vývojovém diagramu. Program se vlastně skládá z jednotlivých částí, které obsluhují sériovou linku, vyzvednutí a uložení přijímacího bufferu do paměti, zápis aktuální skutečné pozice do bufferu a jeho vyslání, sledování polohy na základě snímačů polohy a ovládání pohonů pro pojezd do požadované polohy. Sériová linka je nastavena v režimu 3 jako 9-bitový UART s přenosovou rychlostí 9600Bd. Přijímací i vysílací buffer má 16 bytů. Při příjmu není nutno dodržovat přesně syntaxi komunikačního protokolu (nemusí obsahovat CR LF), protože přijímací buffer je neustále naplňován dokud nedojde k časové prodlevě mezi přenášenými daty (tato prodleva je
10 povinná) minimálně cca. 10ms a lze ji měnit nastavením hodnoty SetIn pro proměnnou TimeIn. V tomto okamžiku je buffer uložen do paměti, nulován a připraven pro další příjem. Protože komunikační protokol je navržen jako 11-ti bytový, je pět bytů bufferu jako rezerva pro případné rozšíření funkce. K vysílání dochází přibližně každých 250ms, což lze opět měnit nastavením hodnoty SetOut pro proměnnou TimeOut. Nejprve je do vysílacího bufferu přesunuta aktuální skutečná pozice polohy háku včetně CR LF a poté je dán požadavek na odeslání dat z bufferu (11 bytů, počet bytů lze opět měnit v SetByte). Skutečná poloha háku jeřábu je dána vyhodnocením sejmutého aktuálního stavu snímače polohy. Tento stav snímače je uložen do paměti a vyhodnocován samostatně pro jednotlivé osy. V případě, že došlo ke změně logické hodnoty od inkrementálního snímače v dané ose, je v závislosti na stavu řídícího signálu snímače k příslušné proměnné přičteno nebo odečteno jedna. Tento postup je stejný pro všechny tři osy. Pohyb háku jeřábu v každé ose je závislý na rozdílu mezi požadovanou hodnotou (přijatou z PC) a skutečnou aktuální pozicí. Pokud jsou obě hodnoty stejné, je pohyb motorku zastaven. V případě rozdílu je vyhodnoceno, jestli je rozdíl kladný nebo záporný a motorek se rozběhne v odpovídajícím směru. Pokud by rozdíl trval, a v kterékoliv ose by došlo k sepnutí koncového spínače, motorek se zastaví. Pohyb je pak možný pouze v druhém směru. Jestliže je však sepnut koncový spínač v kalibrační (výchozí poloze) je současně vynulovaná příslušná proměnná. Zvláštním případem je kalibrace, která se vyvolá požadováním nulové pozice v dané ose. V tomto případě nezáleží na rozdílu hodnot ani na sejmuté aktuální pozici. Motorky jsou zapnuty v příslušném směru tak dlouho, dokud nedojde k sepnutí kalibračních koncových spínačů. Poté jsou příslušné proměnné opět vynulovány. Tento postup je opět stejný pro všechny tři osy.
11 Přiložený vývojový diagram usnadní orientaci v ovládacím programu.
12
Vlastní program v prostředí Control Web 5, vizualizace Součástí předložené práce je i aplikace pro ovládání jeřábu, která je naprogramována ve vývojovém prostředí Control Web 5. Program vytváří především jednoduché prostředí a vizualizaci celého procesu ovládání jeřábu. Pro úplnou představu o činnosti programu je přiložen vývojový diagram.
13 V následujících části je vysvětlení jednotlivých funkcí programu: Ovládání může být realizováno dvěma způsoby. První způsob funguje za pomoci „šipek“ (viz obrázek vlevo). Zvolíme danou osu, kterou chceme ovládat (X,Y,Z) a stiskneme tlačítko. Jeřáb bude v chodu po dobu stisknutí tlačítka. Jakmile tlačítko přestane být stisknuté, jeřáb se zastaví v aktuální pozici.
Druhý způsob představuje ruční zadávání souřadnic. Do pole určeného pro souřadnici vypíšeme danou souřadnici a stiskneme klávesu enter. Jeřáb se uvede do chodu a dojede na souřadnici, kterou jsme zvolili.
Důležitou funkcí modelu jeřábu je také nastavení do výchozí polohy. Toto resetovaní může být buď jednotlivě v každé ose nebo všechny osy najednou. Funkce reset X, Y, Z nám zařídí, že dojde jak k fyzickému nastavení, tak i nastavení os na počáteční bod – souřadnice (0,0,0). V programu je dále implementována nápověda, která slouží k jednoduchému vysvětlení funkcí.
14
Závěr: Touto prací se povedlo sestrojit funkční výukový model, který umožňuje názorné využití ICT při řízení technologických prostředků v automatizaci. Na této práci je také zajímavá ukázka propojeni různých technických oborů, což je v současné technické praxi nezbytným předpokladem úspěchu.
Přílohy: Fotografie
15
16
Výpis programu řídící jednotky JMP
Start
StavHX StavLX PozHX EQU PozLX EQU
EQU EQU 32H 33H
30H 31H
StavHY StavLY PozHY EQU PozLY EQU
EQU EQU 36H 37H
34H 35H
StavHZ StavLZ PozHZ EQU PozLZ EQU
EQU EQU 3AH 3BH
38H 39H
MaskaX MaskaY MaskaZ
SET SET SET
11111100B 11111100B 11111100B
Scan Port
3CH 3DH
EQU EQU
TimeIn
EQU
3EH
TimeOut ByteOut
EQU EQU
3FH 40H
; 11 znaku (3 x 3 byte + CRLF)
;--------------------------------------------------------; ;_XXXXXXXXXXX_____________________________________________ ; <- SetIn ->| (TimeIn) ; | => platny prijem ; ;_XXXXXXXXXXX_______________________________XXXXXXXXXXX___ ; <---------- SetOut ---------->| (TimeOut) ; | => prenos out ; SetIn SET 10 ; v ms SetOut SET 250 ; v ms SetByte SET 11 ; max. 16 znaku, buffer od AdrOut ; posledni znaky CRLF (13,10) ;---------------------------------------------------------; Adr -> buffer (velikost max. 16 znaku Rx i Tx) ; ; pro prijem vice nez 16 znaku budou neustale ukladany ; a prepisovany znaky v bufferu (stale dokola dokud ; nedojde k prodleve TimeIn) ; pri vysilani bude odeslano SetByte znaku z bufferu ; (pozor: SetByte nesmi byt vetsi nez 16) ;---------------------------------------------------------AdrIn SET 50H AdrOut SET AdrIn+16 ;------------------------------------; nastaveni casovace 2 ; pro 1ms/18,432MHz => 64000 tj FA00H SetTH2 SET 0FAH
17 SetTL2
SET
00H
;--------------------------; Definice reg 52, typ BYTE RCAP2L SET 0CAH RCAP2H SET 0CBH TL2 SET 0CCH TH2 SET 0CDH ; typ Bit TR2 SET 0CAH TF2 SET 0CFH ET2 SET 0ADH ;--------------------------ORG JMP
23H IntSer
ORG JMP
2BH Int
Start: MOV MOV MOV MOV MOV MOV
StavHX,#00H StavLX,#00H StavHY,#00H StavLY,#00H StavHZ,#00H StavLZ,#00H
MOV MOV MOV MOV MOV MOV
PozHX,#00H PozLX,#00H PozHY,#00H PozLY,#00H PozHZ,#00H PozLZ,#00H
MOV MOV MOV MOV
TimeIn,#0 TimeOut,#SetOut R0,#AdrIn R1,#AdrOut
MOV MOV
AdrOut+SetByte-2,#13 AdrOut+SetByte-1,#10
; CRLF
; nastavit prenos ;---------------------------------------------------------; Oscil = 256 - f(osc)/32/12/Bd ; MOV 87H,#80H ;SMOD -> 2 x rychlost Oscil SET 251 ; -> 9600b/s (18,432MHz) CLR SM0 SETB SM1 MOV TMOD,#20H MOV TL1,#Oscil MOV TH1,#Oscil SETB TR1 SETB REN ; priznak pro prijem ; nastaveni casovace 2 ;----------------------------------MOV TH2,#SetTH2 MOV RCAP2H,#SetTH2
18 MOV MOV
TL2,#SetTL2 RCAP2L,#SetTL2
SETB
TR2
SETB SETB SETB
ES ET2 EA
JMP
$
; seriovy port ; casovac 2 ; ALL
;======================================================================= ; preruseni kazdou ms od citace 2 ; vyhodnotit pozici k stavu ; ; Poz -> je skutecna pozice jerabu ; Stav -> je pozadovana poloha jerabu ; ;======================================================================= Int: CLR TF2 ; Priznak preruseni -> set softwarove CPL
P1.7
;---------------------------------------------MOV A,TimeIn JZ SkIn1 DJNZ TimeIn,SkIn1 MOV R0,#AdrIn ; ulozit hodnoty do StavX,Y,Z MOV A,AdrIn ANL A,#0FH MOV StavHX,A MOV A,AdrIn+1 ANL A,#0FH SWAP A MOV StavLX,A MOV A,AdrIn+2 ANL A,#0FH ORL StavLX,A ANL StavLX,#MaskaX MOV ANL MOV MOV ANL SWAP MOV MOV ANL ORL ANL
A,AdrIn+3 A,#0FH StavHY,A A,AdrIn+4 A,#0FH A StavLY,A A,AdrIn+5 A,#0FH StavLY,A StavLY,#MaskaY
MOV ANL MOV MOV ANL SWAP
A,AdrIn+6 A,#0FH StavHZ,A A,AdrIn+7 A,#0FH A
19 MOV MOV ANL ORL ANL SkIn1:
StavLZ,A A,AdrIn+8 A,#0FH StavLZ,A StavLZ,#MaskaZ
;---------------------------------------------DJNZ TimeOut,SkIn2 MOV TimeOut,#SetOut ; odeslat hodnoty PozX,Y,Z MOV A,PozHX ANL A,#0FH ORL A,#30H MOV AdrOut,A MOV A,PozLX MOV AdrOut+2,A SWAP A ANL A,#0FH ORL A,#30H MOV AdrOut+1,A ANL AdrOut+2,#0FH ORL AdrOut+2,#30H MOV ANL ORL MOV MOV MOV SWAP ANL ORL MOV ANL ORL
A,PozHY A,#0FH A,#30H AdrOut+3,A A,PozLY AdrOut+5,A A A,#0FH A,#30H AdrOut+4,A AdrOut+5,#0FH AdrOut+5,#30H
MOV ANL ORL MOV MOV MOV SWAP ANL ORL MOV ANL ORL
A,PozHZ A,#0FH A,#30H AdrOut+6,A A,PozLZ AdrOut+8,A A A,#0FH A,#30H AdrOut+7,A AdrOut+8,#0FH AdrOut+8,#30H
MOV MOV
ByteOut,#SetByte R1,#AdrOut
MOV SkIn2:
SBUF,@R1
;---------------------------------------------------------; vyhodnoceni pohybu bit 0,2,4 -> pouze zmena ; MOV A,P0
20 MOV XRL ANL JZ MOV
Port,A A,Scan A,#00010101B Csk04 Scan,A
; Pro motor JNB MOV JB CPL Ask01: DEC MOV CPL JNZ DEC JMP Bsk01: MOV JNZ INC Csk01: MOV
X ACC.0,Csk01 A,Port ACC.0,Ask01 ACC.1 JB ACC.1,Bsk01 PozLX A,PozLX A Csk01 PozHX Csk01 INC PozLX A,PozLX Csk01 PozHX
; Pro motor JNB MOV JB CPL Ask02: DEC MOV CPL JNZ DEC JMP Bsk02: MOV JNZ INC Csk02: MOV
Y ACC.2,Csk02 A,Port ACC.2,Ask02 ACC.3 JB ACC.3,Bsk02 PozLY A,PozLY A Csk02 PozHY Csk02 INC PozLY A,PozLY Csk02 PozHY
; Pro motor JNB MOV JB CPL Ask03: DEC MOV CPL JNZ DEC JMP Bsk03: MOV JNZ INC Csk03:
Z ACC.4,Csk03 A,Port ACC.4,Ask03 ACC.5 JB ACC.5,Bsk03 PozLZ A,PozLZ A Csk03 PozHZ Csk03 INC PozLZ A,PozLZ Csk03 PozHZ
A,Scan
A,Scan
21
MOV Scan,Port Csk04: ;---------------------------------------------; Pojezd do pozadovaneho stavu MOV JNZ MOV JZ
A,StavHX S0X A,StavLX S02
; vychozi pozice pro Stav=0
S0X:
MOV A,PozHX CJNE A,StavHX,SKX01 MOV A,PozLX ANL A,#MaskaX CJNE A,StavLX,SKX01 ; zastavit motor X JMP S01 S00: MOV PozHX,#00H MOV PozLX,#00H S01: SETB P2.0 SETB P2.1 JMP SKX03 S02:
MOV MOV SETB
PozHX,#00H PozLX,#01H C
SKX01: JNC SKX02 JNB P1.0,S00 ; narazi na koncak a nuluje pozici SETB P2.0 CLR P2.1 JMP SKX03 SKX02: JNB P1.1,S01 ; narazi na koncak CLR P2.0 SETB P2.1 SKX03: ; - - - - - - - - - - - - - - - - - - - - - - MOV A,PozHY CJNE A,StavHY,SKY01 MOV A,PozLY ANL A,#MaskaY CJNE A,StavLY,SKY01 ; zastavit motor Y SETB P2.2 SETB P2.3 JMP SKY03 SKY01: JNC SKY02 SETB P2.2 CLR P2.3 JMP SKY03 SKY02: CLR P2.2 SETB P2.3 SKY03: MOV A,PozHZ CJNE A,StavHZ,SKZ01 MOV A,PozLZ ANL A,#MaskaZ CJNE A,StavLZ,SKZ01 ; zastavit motor Z
22 SETB SETB JMP SKZ01: SETB CLR JMP SKZ02: SETB SKZ03: RETI
P2.4 P2.5 SKZ03 JNC SKZ02 P2.4 P2.5 SKZ03 CLR P2.4 P2.5
;======================================================================= IntSer: JNB RI,Sk01 CLR RI CPL
P1.6
MOV MOV INC
TimeIn,#SetIn @R0,SBUF R0
CJNE MOV
R0,#AdrIn+16,Sk01 R0,#AdrIn
JNB CLR
TI,Sk03 TI
; TimeOut pocet preruseni (ms)
Sk01:
DJNZ ByteOut,Sk02 JMP IntSer Sk02: INC R1 MOV SBUF,@R1 JMP IntSer Sk03: RETI ;======================================================================= END
23
Výpis programu v Control Web 5 directories end_directories; settings operation_mode = real_time; startup_options call_procedures = false; activate_receivers = false; output_action = set_local; end_startup_options; end_settings; driver Ovl : 'ascdrv.dll', 'ASCDRV.DMF', 'ASCDRV.PAR'; end_driver; data channel DataIn : string {driver = Ovl; driver_index = 3; direction = input}; DataOut : string {init_value = '0'; driver = Ovl; driver_index = 4; direction = output}; end_channel; var posun1 : boolean {init_value = false; comment = 'tlacitko pro posun'}; posun2 : boolean {init_value = false; comment = 'tlacitko pro posun'}; posun3 : boolean {init_value = false; comment = 'tlacitko pro posun'}; posun4 : boolean {init_value = false; comment = 'tlacitko pro posun'}; posun5 : boolean {init_value = false; comment = 'tlacitko pro posun'}; posun6 : boolean {init_value = false; comment = 'tlacitko pro posun'}; x_osaV : real {init_value = 190; comment = 'souradnice velkeho voziku'}; y_osaV : real {comment = 'souradnice velkeho voziku'}; vyskaV : real {comment = 'souradnice velkeho voziku'}; sirkaV : real {comment = 'souradnice velkeho voziku'}; StavX : real {comment = 'pozadovana hodnota, odesilana'}; StavY : real {comment = 'pozadovana hodnota, odesilana'}; StavZ : real {comment = 'pozadovana hodnota, odesilana'}; pozX : real {comment = 'aktualni pozice jerabu'}; pozY : real {comment = 'aktualni pozice jerabu'}; pozZ : real {comment = 'aktualni pozice jerabu'}; koex : real {comment = 'koecifient pro meritko velikosti'}; koey : real {comment = 'koecifient pro meritko velikosti'}; koez : real {comment = 'koecifient pro meritko velikosti'}; x_osaL : real {comment = 'souradnice velkeho lanka'}; y_osaL : real {comment = 'souradnice velkeho lanka'}; vyskaL : real {comment = 'souradnice velkeho lanka'}; sirkaL : real {comment = 'souradnice velkeho lanka'}; x_osaH : real {comment = 'souradnice velkeho "haku"'}; y_osaH : real {comment = 'souradnice velkeho "haku"'}; sirkaH : real {comment = 'souradnice velkeho "haku"'}; vyskaH : real {comment = 'souradnice velkeho "haku"'}; x_osaM : real; y_osaM : real; sirkaM : real; vyskaM : real; x_osaHM : real; y_osaHM : real;
24 x_osaLM : real; y_osaLM : real; napoveda : boolean {init_value = false}; skryj_nap : boolean {init_value = true}; o_programu : boolean {init_value = false}; skryj_prog : boolean {init_value = true}; vypnout : boolean {init_value = false; comment = 'vypne aplikaci (program)'}; start_programu : boolean {init_value = false; comment = 'pri startu programu nastavi X,Y,Z na nulu'}; resetX : boolean {init_value = false; comment = 'reset X na nulu'}; resetY : boolean {init_value = false; comment = 'reset Y na nulu'}; resetZ : boolean {init_value = false; comment = 'reset Z na nulu'}; resetXYZ : boolean {init_value = false; comment = 'reset X,Y,Z na nulu'}; prom : boolean {init_value = false; comment = 'pomocna promenna'}; end_var; end_data; instrument panel panel_1; timer = 0.1; owner = background; position = 10, 70, 1000, 600; window = normal; win_title = 'Jerab beta 1.0'; win_disable = zoom, minimize, maximize; dv_file = 'JERAB_PANEL.JPG'; procedure OnActivate(); begin ukazatel1.Disable(); ukazatel2.Disable(); ukazatel3.Disable();
if start_programu = false then if pozX <> StavX then StavX = 0; start_programu = true; else start_programu = true; end; if pozY <> StavY then StavY = 0; start_programu = true; else start_programu = true; end; if pozZ <> StavZ then StavZ = 0; start_programu = true; else start_programu = true; end;
25 end; end_procedure; end_panel; panel o_programu; timer = 0.1; owner = panel_1; position = -3, 50, 1000, 350; visibility = skryj_prog; dv_file = 'O_PROGRAMU.JPG'; procedure OnActivate(); begin end_procedure; end_panel; switch switch_3; timer = 0.1; owner = o_programu; position = 854, 315, 137, 31; win_disable = zoom, maximize; output = o_programu; mode = text_button; font = 'Microsoft Sans Serif (Central European)', 11, bold; true_text = 'Zavøi o programu'; false_text = 'Zavøi o programu'; auto_update; end_switch; panel napoveda; timer = 0.1; owner = panel_1; position = -3, 50, 1000, 350; visibility = skryj_nap; dv_file = 'NAPOVEDA.JPG'; procedure OnActivate(); begin if napoveda = true then if o_programu = true then o_programu = false; skryj_prog = false; end; skryj_nap = true; end; if napoveda = false then skryj_nap = false; end; if o_programu = true then if napoveda = true then napoveda = false; skryj_nap = false; end; skryj_prog = true; end;
26 if o_programu = false then skryj_prog = false; end; if o_programu = true then napoveda = false; skryj_nap = false; o_programu = true; skryj_prog = true; end; end_procedure; end_panel; switch switch_3; timer = 0.1; owner = napoveda; position = 814, 295, 165, 36; win_disable = zoom, maximize; output = napoveda; mode = text_button; font = 'Microsoft Sans Serif (Central European)', 11, bold; true_text = 'Zavøi nápovìdu'; false_text = 'Zavøi nápovìdu'; auto_update; end_switch; meter meter_1; timer = 0.1; owner = panel_1; position = 375, 500, 75, 20; expression = pozY; mode = text_display; range_to = 4000; low_limit = 50; high_limit = 3950; font = font_caption; colors paper = black; value = blue; low_limit = red; high_limit = red; end_colors; end_meter; panel lanko1; timer = 0.1; owner = panel_1; position = 731, 130, 3, 1; dv_file = 'LANO.JPG'; end_panel; panel hak1; timer = 0.1; owner = panel_1; position = 726, 130, 14, 21; dv_file = 'HAK.JPG'; end_panel; control ukazatel3; timer = 0.1;
27 owner = panel_1; position = 456, 530, 70, 12; output = StavZ; mode = horizontal_slider; range_to = 4000; real_step = 10; auto_update; colors border_paper = green; top_shadow = color_window; bottom_shadow = 76, 120, 157; paper = color_highlight; mark = magenta; select = color_windowtext; end_colors; end_control; control ukazatel2; timer = 0.1; owner = panel_1; position = 456, 500, 70, 12; output = StavY; mode = horizontal_slider; range_to = 4000; real_step = 10; auto_update; colors border_paper = green; top_shadow = color_window; bottom_shadow = 76, 120, 157; paper = color_highlight; mark = magenta; select = color_windowtext; end_colors; end_control; panel hak; timer = 0.1; owner = panel_1; position = 101, 130, 14, 21; dv_file = 'HAK.JPG'; end_panel; panel lanko; timer = 0.1; owner = panel_1; position = 106, 130, 3, 1; dv_file = 'LANO.JPG'; end_panel; panel vozik_mal; timer = 0.01; owner = panel_1; position = 716, 90, 30, 27; dv_file = 'VOZIK_02.JPG'; end_panel; panel vozik_velky; timer = 0.01; owner = panel_1; position = 80, 90, 54, 28;
28 dv_file = 'VOZIK_01.JPG'; procedure OnActivate(); begin koex = 9.3; koey = 23.5; koez = 20; if posun1 = true then if StavX >= 4001 then StavX = 4000; end; if StavX <= -1 then StavX = 0; end; StavX = StavX + 1; vozik_velky.GetRect(&x_osaV,&y_osaV,&sirkaV,&vyskaV); vozik_velky.MoveTo((pozX / koex) + 80,y_osaV); lanko.GetRect(&x_osaL,&y_osaL,&sirkaL,&vyskaL); lanko.MoveTo((pozX / koex) + 106,y_osaL); hak.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak.MoveTo((pozX / koex) + 101,y_osaH); else vozik_velky.GetRect(&x_osaV,&y_osaV,&sirkaV,&vyskaV); vozik_velky.MoveTo(x_osaV,y_osaV); lanko.GetRect(&x_osaL,&y_osaL,&sirkaL,&vyskaL); lanko.MoveTo(&x_osaL,y_osaL); hak.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak.MoveTo(&x_osaH,y_osaH); end; if posun2 = true then if StavX >= 4001 then StavX = 4000; end; if StavX <= -1 then StavX = 0; end; StavX = StavX - 1; vozik_velky.GetRect(&x_osaV,&y_osaV,&sirkaV,&vyskaV); vozik_velky.MoveTo((pozX / koex) + 80,y_osaV); lanko.GetRect(&x_osaL,&y_osaL,&sirkaL,&vyskaL); lanko.MoveTo((pozX / koex) + 106,y_osaL); hak.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak.MoveTo((pozX / koex) + 101,y_osaH); else vozik_velky.GetRect(&x_osaV,&y_osaV,&sirkaV,&vyskaV); vozik_velky.MoveTo(x_osaV,y_osaV); lanko.GetRect(&x_osaL,&y_osaL,&sirkaL,&vyskaL); lanko.MoveTo(&x_osaL,y_osaL); hak.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak.MoveTo(&x_osaH,y_osaH); end;
if posun5 = true then if StavY >= 4001 then StavY = 4000; end; if StavY <= -1 then
29 StavY = 0; end; StavY = StavY + 1; vozik_mal.GetRect(&x_osaM,&y_osaM,&sirkaM,&vyskaM); vozik_mal.MoveTo((pozY / koey) + 718,y_osaM); lanko1.GetRect(&x_osaLM,&y_osaLM,&sirkaL,&vyskaL); lanko1.MoveTo((pozY / koey) + 730,y_osaLM); hak1.GetRect(&x_osaHM,&y_osaHM,&sirkaH,&vyskaH); hak1.MoveTo((pozY / koey) + 725,y_osaHM); else lanko1.GetRect(&x_osaLM,&y_osaLM,&sirkaL,&vyskaL); lanko1.MoveTo(x_osaLM,y_osaLM); hak1.GetRect(&x_osaHM,&y_osaHM,&sirkaH,&vyskaH); hak1.MoveTo(&x_osaHM,y_osaHM); end; if posun6 = true then if StavY >= 4001 then StavY = 4000; end; if StavY <= -1 then StavY = 0; end; StavY = StavY - 1; vozik_mal.GetRect(&x_osaM,&y_osaM,&sirkaM,&vyskaM); vozik_mal.MoveTo((pozY / koey) + 718,y_osaM); lanko1.GetRect(&x_osaLM,&y_osaLM,&sirkaL,&vyskaL); lanko1.MoveTo((pozY / koey) + 730,y_osaLM); hak1.GetRect(&x_osaHM,&y_osaHM,&sirkaH,&vyskaH); hak1.MoveTo((pozY / koey) + 725,y_osaHM); else lanko1.GetRect(&x_osaLM,&y_osaLM,&sirkaL,&vyskaL); lanko1.MoveTo(x_osaLM,y_osaLM); hak1.GetRect(&x_osaHM,&y_osaHM,&sirkaH,&vyskaH); hak1.MoveTo(&x_osaHM,y_osaHM); end;
if posun4 = true then if StavZ >= 4001 then StavZ = 4000; end; if StavZ <= -1 then StavZ = 0; end; StavZ = StavZ + 1; lanko.Size( 3, (pozZ / koez)); hak.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak.MoveTo(x_osaH,(pozZ / koez) + 130); lanko1.Size( 3, (pozZ / koez)); hak1.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak1.MoveTo(x_osaH,(pozZ / koez) + 130); end; if posun3 = true then if StavZ >= 4001 then StavZ = 4000; end; if StavZ <= -1 then StavZ = 0;
30 end; StavZ = StavZ - 1; lanko.Size( 3, (pozZ / koez)); hak.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak.MoveTo(x_osaH,(pozZ / koez) + 130); lanko1.Size( 3, (pozZ / koez)); hak1.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak1.MoveTo(x_osaH,(pozZ / koez) + 130) end; end_procedure; end_panel; switch switch_7; timer = 0.1; owner = panel_1; position = 301, 565, 80, 26; win_disable = zoom, maximize; output = resetXYZ; mode = text_button; true_text = 'Reset X,Y,Z'; false_text = 'Reset X,Y,Z'; logic = set_true_on_press; end_switch; switch switch_7; timer = 0.1; owner = panel_1; position = 536, 565, 80, 26; win_disable = zoom, maximize; output = vypnout; mode = text_button; true_text = 'Vypnout'; false_text = 'Vypnout'; procedure OnActivate(); begin if vypnout = true then core.StopApplication(); end; end_procedure; end_switch; switch switch_7; timer = 0.1; owner = panel_1; position = 456, 565, 80, 26; win_disable = zoom, maximize; output = o_programu; mode = text_button; true_text = 'O Programu'; false_text = 'O Programu'; auto_update; end_switch; switch switch_7; timer = 0.1; owner = panel_1; position = 376, 565, 80, 26;
31 win_disable = zoom, maximize; output = napoveda; mode = text_button; true_text = 'Nápovìda'; false_text = 'Nápovìda'; auto_update; end_switch; switch switch_7; timer = 0.1; owner = panel_1; position = 221, 565, 80, 26; win_disable = zoom, maximize; output = resetZ; mode = text_button; true_text = 'Reset Z'; false_text = 'Reset Z'; end_switch; switch switch_7; timer = 0.1; owner = panel_1; position = 141, 565, 80, 26; win_disable = zoom, maximize; output = resetY; mode = text_button; true_text = 'Reset Y'; false_text = 'Reset Y'; end_switch; switch switch_7; timer = 0.1; owner = panel_1; position = 61, 565, 80, 26; win_disable = zoom, maximize; output = resetX; mode = text_button; true_text = 'Reset X'; false_text = 'Reset X'; procedure OnActivate(); begin if resetX = true then if pozX <> 0 then StavX = 0 ; resetX = false; end; end; if resetY = true then if pozY <> 0 then StavY = 0 ; resetY = false; end; end; if resetZ = true then if pozZ <> 0 then StavZ = 0 ; resetZ = false;
32 end; end; if resetXYZ = true then if pozZ <> 0 then StavZ = 0 ; end; if pozY <> 0 then StavY = 0 ; end; if pozX <> 0 then StavX = 0 ; end; end; end_procedure; end_switch; control ukazatel1; timer = 0.1; owner = panel_1; position = 456, 470, 70, 12; win_title = 'true'; output = StavX; mode = horizontal_slider; range_to = 4000; real_step = 10; auto_update; colors border_paper = green; top_shadow = color_window; bottom_shadow = 76, 120, 157; paper = color_highlight; mark = magenta; select = color_windowtext; end_colors; end_control; meter meter_1; timer = 0.1; owner = panel_1; position = 376, 530, 75, 20; expression = pozZ; mode = text_display; range_to = 4000; low_limit = 10; high_limit = 990; font = font_caption; colors paper = black; value = blue; low_limit = red; high_limit = red; end_colors; end_meter; meter meter_1; timer = 0.1; owner = panel_1; position = 376, 470, 75, 20; expression = pozX;
33 mode = text_display; range_to = 4000; low_limit = 50; high_limit = 3950; font = font_caption; colors paper = black; value = blue; low_limit = red; high_limit = red; end_colors; end_meter; switch switch_6; timer = 0.1; owner = panel_1; position = 185, 515, 46, 33; win_disable = zoom, maximize; output = posun4; true_icon = 'sipka02.ICO'; false_icon = 'sipka02.ICO'; logic = set_true_on_press; end_switch; switch switch_5; timer = 0.1; owner = panel_1; position = 185, 480, 47, 33; win_disable = zoom, maximize; output = posun3; true_icon = 'sipka01.ICO'; false_icon = 'sipka01.ICO'; logic = set_true_on_press; end_switch; switch switch_4; timer = 0.1; owner = panel_1; position = 110, 515, 47, 33; win_disable = zoom, maximize; output = posun6; true_icon = 'sipka03.ICO'; false_icon = 'sipka03.ICO'; logic = set_true_on_press; end_switch; switch switch_3; timer = 0.1; owner = panel_1; position = 110, 480, 47, 33; win_disable = zoom, maximize; output = posun5; true_icon = 'sipka04.ICO'; false_icon = 'sipka04.ICO'; logic = set_true_on_press; end_switch; switch switch_2; timer = 0.1; owner = panel_1; position = 60, 515, 46, 33;
34 win_disable = zoom, maximize; output = posun2; true_icon = 'sipka02.ICO'; false_icon = 'sipka02.ICO'; logic = set_true_on_press; end_switch; switch switch_1; timer = 0.1; owner = panel_1; position = 60, 480, 47, 33; win_disable = zoom, maximize; output = posun1; true_icon = 'sipka01.ICO'; false_icon = 'sipka01.ICO'; logic = set_true_on_press; procedure OnActivate(); begin end_procedure; end_switch; panel panel_3; owner = panel_1; position = 651, 440, 330, 135; dv_file = 'PANEL_1.JPG'; colors color = 76, 120, 157; end_colors; end_panel; control control_4; timer = 0.1; owner = panel_3; position = 225, 30, 82, 85; output = StavZ; mode = turn; content = max; range_to = 4000; dec_places = 0; colors border_ink = color_btnshadow; border_paper = 76, 120, 157; top_shadow = 76, 120, 157; bottom_shadow = 0, 73, 163; ink = black; paper = color_scrollbar; mark = color_btnface; select = lred; end_colors; procedure OnActivate(); begin if StavZ <> pozZ then lanko.Size( 3, (pozZ / koez)); hak.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak.MoveTo(x_osaH,(pozZ / koez) + 130); lanko1.Size( 3, (pozZ / koez)); hak1.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak1.MoveTo(x_osaH,(pozZ / koez) + 130);
35 end; end_procedure; end_control; control control_4; timer = 0.1; owner = panel_3; position = 125, 30, 82, 85; output = StavY; mode = turn; content = max; range_to = 4000; dec_places = 0; colors border_ink = color_btnshadow; border_paper = 76, 120, 157; top_shadow = 76, 120, 157; bottom_shadow = 0, 73, 163; ink = black; paper = color_scrollbar; mark = color_btnface; select = lred; end_colors; procedure OnActivate(); begin if StavY <> pozY then vozik_mal.GetRect(&x_osaM,&y_osaM,&sirkaM,&vyskaM); vozik_mal.MoveTo((pozY / koey) + 718,y_osaM); lanko1.GetRect(&x_osaLM,&y_osaLM,&sirkaL,&vyskaL); lanko1.MoveTo((pozY / koey) + 730,y_osaLM); hak1.GetRect(&x_osaHM,&y_osaHM,&sirkaH,&vyskaH); hak1.MoveTo((pozY / koey) + 725,y_osaHM); end; end_procedure; end_control; control control_4; timer = 0.1; owner = panel_3; position = 25, 30, 82, 85; output = StavX; mode = turn; content = max; range_to = 4000; dec_places = 0; colors border_ink = color_btnshadow; border_paper = 76, 120, 157; top_shadow = 76, 120, 157; bottom_shadow = 0, 73, 163; ink = black; paper = color_scrollbar; mark = color_btnface; select = lred; end_colors; procedure OnActivate();
36 begin
if StavX <> pozX then vozik_velky.GetRect(&x_osaV,&y_osaV,&sirkaV,&vyskaV); vozik_velky.MoveTo((pozX / koex) + 80,y_osaV); lanko.GetRect(&x_osaL,&y_osaL,&sirkaL,&vyskaL); lanko.MoveTo((pozX / koex) + 106,y_osaL); hak.GetRect(&x_osaH,&y_osaH,&sirkaH,&vyskaH); hak.MoveTo((pozX / koex) + 101,y_osaH); end; end_procedure; end_control; string_display string_display_1; var Prijem : string {init_value = '0'}; Odeslat : string {init_value = '0'}; PomStrg : string {init_value = '0'}; PomStav : real; PomZnak : real; end_var; position = 180, 45, 200, 18; driver_exception = Ovl; expression = DataIn; procedure OnActivate(); begin Prijem = DataIn; pozX = ((ord(slice(Prijem,0,1))-48)*16+ord(slice(Prijem,1,1))48)*16+ord(slice(Prijem,2,1))-48; pozY = ((ord(slice(Prijem,3,1))-48)*16+ord(slice(Prijem,4,1))48)*16+ord(slice(Prijem,5,1))-48; pozZ = ((ord(slice(Prijem,6,1))-48)*16+ord(slice(Prijem,7,1))48)*16+ord(slice(Prijem,8,1))-48; if StavX>4000 then PomStrg = '???'; else PomStav = StavX; PomZnak = trunc(PomStav/256); PomStrg = char(PomZnak+48); PomStav = PomStav - PomZnak * 256; PomZnak = trunc(PomStav/16); PomStrg = concat(PomStrg,char(PomZnak+48)); PomStav = PomStav - PomZnak * 16; PomStrg = concat(PomStrg,char(PomStav+48)); end; Odeslat = PomStrg; if StavY>4000 then PomStrg = '???'; else PomStav = StavY; PomZnak = trunc(PomStav/256); PomStrg = char(PomZnak+48); PomStav = PomStav - PomZnak * 256; PomZnak = trunc(PomStav/16);
37 PomStrg = concat(PomStrg,char(PomZnak+48)); PomStav = PomStav - PomZnak * 16; PomStrg = concat(PomStrg,char(PomStav+48)); end; Odeslat = concat(Odeslat,PomStrg); if StavZ>4000 then PomStrg = '???'; else PomStav = StavZ; PomZnak = trunc(PomStav/256); PomStrg = char(PomZnak+48); PomStav = PomStav - PomZnak * 256; PomZnak = trunc(PomStav/16); PomStrg = concat(PomStrg,char(PomZnak+48)); PomStav = PomStav - PomZnak * 16; PomStrg = concat(PomStrg,char(PomStav+48)); end; Odeslat = concat(Odeslat,PomStrg); DataOut = Odeslat; end_procedure; end_string_display; end_instrument;
