5RERWLFV
6WXGHQW*XLGHIRU([SHULPHQWVWKURXJK
9HUVLRQ
1RWHUHJDUGLQJDFFXUDF\RIWKLVWH[W
0DQ\ HIIRUWV ZHUH WDNHQ WR HQVXUH DFFXUDF\ RI WKLV WH[W DQG WKH
H[SHULPHQWVEXWWKHSRWHQWLDOIRUHUURUVVWLOOH[LVW,I\RXILQGHUURUV
RUDQ\VXEMHFWUHTXLULQJDGGLWLRQDOH[SODQDWLRQSOHDVHUHSRUWWKLVWR
VWDPSVLQFODVV#SDUDOOD[LQFFRP VR ZH FDQ FRQWLQXH WR LPSURYH WKH
TXDOLW\RIRXUGRFXPHQWDWLRQ
:DUUDQW\
3DUDOOD[ZDUUDQWVLWVSURGXFWVDJDLQVWGHIHFWVLQPDWHULDOVDQGZRUNPDQVKLSIRUDSHULRGRIGD\V,I\RXGLVFRYHUDGHIHFW3DUDOOD[
ZLOODWLWVRSWLRQUHSDLUUHSODFHRUUHIXQGWKHSXUFKDVHSULFH6LPSO\FDOOIRUD5HWXUQ0HUFKDQGLVH$XWKRUL]DWLRQ50$QXPEHU
ZULWH WKH QXPEHU RQ WKH RXWVLGH RI WKH ER[ DQG VHQG LW EDFN WR 3DUDOOD[ 3OHDVH LQFOXGH \RXU QDPH WHOHSKRQH QXPEHU VKLSSLQJ
DGGUHVVDQGDGHVFULSWLRQRIWKHSUREOHP:HZLOOUHWXUQ\RXUSURGXFWRULWVUHSODFHPHQWXVLQJWKHVDPHVKLSSLQJPHWKRG XVHGWR
VKLSWKHSURGXFWWR3DUDOOD[
'D\0RQH\%DFN*XDUDQWHH
,IZLWKLQGD\VRIKDYLQJUHFHLYHG\RXUSURGXFW\RXILQGWKDWLWGRHVQRWVXLW\RXUQHHGV\RXPD\UHWXUQLWIRUDIXOOUHIXQG3DUDOOD[
ZLOOUHIXQGWKHSXUFKDVHSULFHRIWKHSURGXFWH[FOXGLQJVKLSSLQJKDQGOLQJFRVWV7KLVGRHVQRWDSSO\LIWKHSURGXFWKDVEHHQDOWHUHG
RUGDPDJHG
&RS\ULJKWVDQG7UDGHPDUNV
7KLVGRFXPHQWDWLRQLVFRS\ULJKWE\3DUDOOD[,QF%$6,&6WDPSLVDUHJLVWHUHGWUDGHPDUNRI3DUDOOD[,QF,I\RXGHFLGHGWRXVHWKH
QDPH%$6,&6WDPSRQ\RXUZHESDJHRULQSULQWHGPDWHULDO\RXPXVWVWDWHWKDW%$6,&6WDPSLVDUHJLVWHUHGWUDGHPDUNRI3DUDOOD[
,QF2WKHUEUDQGDQGSURGXFWQDPHVDUHWUDGHPDUNVRUUHJLVWHUHGWUDGHPDUNVRIWKHLUUHVSHFWLYHKROGHUV
'LVFODLPHURI/LDELOLW\
3DUDOOD[,QFLVQRWUHVSRQVLEOHIRUVSHFLDOLQFLGHQWDORUFRQVHTXHQWLDOGDPDJHVUHVXOWLQJIURPDQ\EUHDFKRIZDUUDQW\RUXQGHUDQ\
OHJDO WKHRU\ LQFOXGLQJ ORVW SURILWV GRZQWLPH JRRGZLOO GDPDJH WR RU UHSODFHPHQW RI HTXLSPHQW RU SURSHUW\ DQG DQ\ FRVWV RU
UHFRYHULQJUHSURJUDPPLQJRUUHSURGXFLQJDQ\GDWDVWRUHGLQRUXVHGZLWK3DUDOOD[SURGXFWV3DUDOOD[LVDOVRQRWUHVSRQVLEOHIRUDQ\
SHUVRQDOGDPDJHLQFOXGLQJWKDWWROLIHDQGKHDOWKUHVXOWLQJIURPXVHRIDQ\RIRXUSURGXFWV<RXWDNHIXOOUHVSRQVLELOLW\IRU\RXU%$6,&
6WDPSDSSOLFDWLRQ
,QWHUQHW$FFHVV
:H PDLQWDLQ LQWHUQHW V\VWHPV IRU \RXU XVH 7KHVH PD\ EH XVHG WR REWDLQ VRIWZDUH FRPPXQLFDWH ZLWK PHPEHUV RI 3DUDOOD[ DQG

3DUWV5HTXLUHG 
%XLOG,W 
3URJUDP,W
6RXQG)HHGEDFN 
/(')HHGEDFN
'LVWDQFH&DOLEUDWLRQ 
0DNLQJ7XUQV
*RWR6WDWHPHQW 
*RVXE$&ORVH5HODWLYHRI*RWR
8VLQJWKH'DWD&RPPDQGDQG((3520WR6WRUH0RYHPHQWV
$OO7RJHWKHU1RZ
&KDOOHQJH 
([SHULPHQW)ROORZLQJ/LJKW 
3DUWV5HTXLUHG 
%XLOG,W 
3URJUDP,W
8VLQJWKH3KRWRUHVLVWRU
&KDOOHQJH
&RQWHQWV
3DJH•

5RERWLFV6WXGHQW*XLGH9HUVLRQ
([SHULPHQW,QIUDUHG2EMHFW'HWHFWLRQ
,QIUDUHG7UDQVPLVVLRQ 
,QIUDUHG5HFHSWLRQ  
%XLOG,W 
3URJUDP,W 
,QIUDUHG7UDQVPLWDQG5HFHLYH 
7URXEOHVKRRWLQJ 
&KDOOHQJH  

PLQLPDO RYHUODS EHWZHHQ WKH RWKHU WH[WV 7RSLFV LQWURGXFHG LQ WKLV VHULHV DUH ((3520 GDWD VWRUDJH
PHFKDQLFVRIEDVLFURERWLFVVHUYRFRQWUROLQIUDUHGREVWDFOHGHWHFWLRQDQGFRPPXQLFDWLRQDQG WKHXVHRI
SKRWRUHVLVWRUV
7KH GHSWK DQG DYDLODELOLW\ RI D 7HDFKHUnV *XLGH YDULHV EHWZHHQ WKH 6WDPSV LQ &ODVV FXUULFXOXP
%HFDXVHH[SHUWVLQWKHLUILHOGLQGHSHQGHQWO\DXWKRUHDFKVHWRIH[SHULPHQWVDQGWKH\DUHSURYLGHGOHHZD\LQ
WHUPVRIIRUPDW3OHDVHFDOOLI\RXKDYHDQ\TXHVWLRQV
3UHIDFH
3DJH•

5RERWLFV6WXGHQW*XLGH9HUVLRQ
&RS\ULJKWDQG5HSURGXFWLRQ
6WDPSVLQ&ODVVFXUULFXOXPLVFRS\ULJKW3DUDOOD[3DUDOOD[JUDQWV HYHU\SHUVRQ FRQGLWLRQDO
ULJKWVWRGRZQORDGGXSOLFDWHDQGGLVWULEXWHWKLVWH[WZLWKRXWRXUSHUPLVVLRQ7KHFRQGLWLRQLVWKDWWKLVWH[W
RUDQ\SRUWLRQWKHUHRIVKRXOGQRWEHGXSOLFDWHGIRUFRPPHUFLDOXVHUHVXOWLQJLQH[SHQVHVWRWKHXVHUEH\RQG
WKHPDUJLQDOFRVWRISULQWLQJ7KDWLVQRERG\ZRXOGSURILWIURPGXSOLFDWLRQRIWKLVWH[W3UHIHUDEO\GXSOLFDWLRQ
ZRXOGKDYHQRH[SHQVHWR WKHVWXGHQW$Q\HGXFDWLRQDOLQVWLWXWLRQZLVKLQJ WRSURGXFH GXSOLFDWHV IRU WKHLU
VWXGHQWV PD\ GR VR ZLWKRXW RXU SHUPLVVLRQ 7KLV WH[W LV DOVR DYDLODEOH LQ SULQWHG IRUPDW IURP 3DUDOOD[
%HFDXVHZHSULQWWKHWH[WLQYROXPHWKHFRQVXPHUSULFHLVRIWHQOHVVWKDQW\SLFDO[HURJUDSKLFGXSOLFDWLRQ
FKDUJHV7KLVWH[WPD\EHWUDQVODWHGWRDQ\RWKHUODQJXDJHZLWKWKHSHUPLVVLRQRI3DUDOOD[,QF
6SHFLDO&RQWULEXWRUV
&KXFN6FKRHIIOHU3K'DWWKH8QLYHUVLW\RI,GDKRDXWKRUHGSRUWLRQVRIWKLVFXUULFXOXPLQFRQMXQFWLRQ
ZLWK3DUDOOD[,QF&KXFNLVDSURIHVVRULQ8,V,QGXVWULDO7HFKQRORJ\(GXFDWLRQGHSDUWPHQW+HVSHFLDOL]HVZLWK
PHFKDQLFDODQGHOHFWULFDOGHVLJQVDQGZLWKRXWTXHVWLRQRQHRIKLVKREELHVLVURERWLFVDQGWKH%$6,&6WDPS
&KXFN GHVLJQHG WKH RULJLQDO %RDUG RI (GXFDWLRQ 5RERW %RH%RW VKRZQ EHORZ DQG PDQ\ VLPLODU URERW
GHULYDWLYHVZLWKXQLTXHIXQFWLRQV$IWHUVHYHUDOYHUVLRQV&KXFNVGHVLJQZDVDGRSWHGDVWKHEDVLVRIWKH
3DUDOOD[%RH%RWWKDWLVXVHGLQWKLV5RERWLFVFXUULFXOXP&KXFNWHDFKHVURERWLFVWRDOOOHYHOVUDQJLQJIURP
KLJK VFKRRO VWXGHQWV WR KLV VXPPHU ZRUNVKRSV ZLWK
WHDFKHUV2QIUHHWLPHKHLVNQRZQWREHIL[LQJ
DXWRPRELOHV IRU KLVIDPLO\ DQGULGLQJKLVPRWRUF\FOH LQ
WKHKLOOVDURXQG0RVFRZ,GDKR<RXFDQUHDFK&KXFNE\

%RW$IWHUWKDWZHOOEHSURJUDPPLQJWKH%RH%RWIRUEDVLFPDQHXYHUVDQGSURFHHGWRLQWHUIDFHVHQVRUVWKDW
ZLOODOORZWKHURERWUHDFWWRLWnVVXUURXQGLQJV
([SHULPHQW%RH%RW&RQVWUXFWLRQ
3DJH•

5RERWLFV6WXGHQW*XLGH9HUVLRQ
3DUWV
5HTXLUHG
$ %RH%RW FDQ WDNH PDQ\ GLIIHUHQW IRUPV RI FRQVWUXFWLRQ DQG LW
GRHVQW KDYH WR XVH WKH 3DUDOOD[ %RH%RW FKDVVLV ZLWK D %RDUG RI
(GXFDWLRQDQG%$6,&6WDPS2QHDSSURDFKPLJKWEHWREXLOGDUROOLQJ
EUHDGERDUG ZLWK VHUYRV DWWDFKHG XVLQJ GRXEOHVLGHG WDSH DQG
DQRWKHU PLJKW EH WR FDUYH D URERW EDVH IURP D SLHFH RI SODVWLF
LUULJDWLRQSLSH,I\RXDUHXVLQJD%$6,&6WDPS,,DQGWKHVFKHPDWLFV
DQGVRXUFHFRGHLQFOXGHGLQWKLVVHULHVRIH[SHULPHQWV\RXUURERWZRXOGZRUNILQHDQGEHMXVWDVXQLTXH,W
PLJKWORRNGLIIHUHQWWKDQWKH%RH%RWEXWWKDWVDSSURSULDWHVLQFHWKHGHVLJQKDVDORWGRWRZLWKFUHDWLYLW\
,I\RXUHXVLQJWKH%RH%RWIURP3DUDOOD[\RXOOQHHGWKHIROORZLQJSDUWVIRUWKLVH[SHULPHQWDOODUHLQWKH
5RERWLFV3DUWV.LW
 %RH%RWFKDVVLV
 7ZRVWDQGDUGVHUYRV)XWDED6VRUWKRVHVXSSOLHGZLWKWKH5RERWLFV3DUWVNLW
 SODVWLFZKHHOV
 2ULQJWLUHV
 SRO\HWK\OHQHEDOOZKHHO
 FRWWHUSLQWRKROGZKHHORQFKDVVLV
 PDFKLQHVFUHZV
 PDFKLQHVFUHZV
 IODWKHDGVFUHZV
 Q\ORQLQVHUWORFNLQJQXWV
 VWDQGRIIV
 JURPPHWLQQHUGLDPHWHUILWVpKROH

0RGLI\LQJWKHVHUYRVWDNHVRQO\DIHZPLQXWHVDQGUHTXLUHVD3KLOOLSVVFUHZGULYHUGLDJRQDOFXWWHUVDQGDOLWWOH
FDUHIXOGLVDVVHPEO\7KLVPRGLILFDWLRQFDQEHUHYHUVHGDWDODWHUGDWHWRUHWXUQWRWKHWRDQJOHLI\RX
VDYHWKHVPDOOSODVWLFGULYHSODWHZHUHJRLQJWRUHPRYHLWEXW\RXnOOQHHGWREHFDUHIXOQRWWRGDPDJHWKH
LQWHUQDOSDUWVE\WXUQLQJWKHRXWSXWVKDIWWRRIDU
7KHVHUYRV KDYHD FRQWUROKRUQDWWDFKHGWRWKHPDLQ RXWSXWVKDIW WKDW LV VHFXUHG LQ SODFH ZLWK D 3KLOOLSV
VFUHZ7XUQWKHVHUYRKRUQZLWK\RXUILQJHUVXQWLOLWVWRSVVR\RXKDYHDQLGHDRIWKHSK\VLFDOOLPLWDWLRQ:H
QHHGWRPRGLI\LWVRWKDWWKHFRQWUROKRUQZLOOURWDWHFRQWLQXRXVO\
5HPRYHWKHVPDOO3KLOOLSVVFUHZKROGLQJWKHFRQWUROKRUQRQWKHVHUYR7KHVKDIWKDVVSOLQHVRQLWVR\RXZLOO
KDYHWRDSSO\XSZDUGSUHVVXUHDQGWKHQZLJJOHWKHFRQWUROKRUQRII/RRNDWWKHERWWRPRIWKHVHUYRDQGILQG
WKHIRXU3KLOOLSVKHDGVFUHZVRQWKHERWWRPRIWKHFDVHEHFDXVH\RXZLOOQHHGWRUHPRYHWKRVHLQDGGLWLRQWR
WKHRQH3KLOOLSVVFUHZWKDWZDVKROGLQJWKHFRQWUROKRUQRQWKHPDLQRXWSXWJHDU
([SHULPHQW%RH%RW&RQVWUXFWLRQ
3DJH•

5RERWLFV6WXGHQW*XLGH9HUVLRQ
7KHERWWRPSODWHRIWKHVHUYRZLOOFRPHRIIDWWKLVSRLQWVRORRNDWWKHFRQWUROFLUFXLWU\<RXZRQWQHHGWRGR
DQ\VROGHULQJXQOHVV\RXEUHDNDZLUHRII+ROG\RXUILQJHURQWKHRXWSXWJHDUVKDIWDQGSUHVVGRZQWKHRQH
WKDWWKHFRQWUROKRUQZDVRQDQGFDUHIXOO\SU\DQGZLJJOHWKHWRSRIWKHVHUYRFDVHXSDQGUHPRYHLW:RUN
VORZO\VRWKHJHDUVDOOVWD\LQSODFHRQWKHLUVKDIWVDQGWU\WRNHHSWKHERWWRPSODWHFRQQHFWHGWRWKHFDVH
2QFHUHPRYHG\RXUVHUYRVKRXOGORRNOLNH)LJXUH
7KHILQDOJHDULVWKHRQH\RXDUHJRLQJWRPRGLI\,WnVDOVRWKHRQH\RXKHOGGRZQZLWK\RXUILQJHU<RXOOQHHG
WRUHPRYHWKHUGJHDULQRUGHUWRDFFHVVWKHILQDOJHDU/RRNLQJDWWKHWRSRIWKHILQDOJHDU\RXnOOVHHDSODVWLF
VWRSWDEWKDWZHQHHGWRFXWRIIWRPDNHWKHVHUYRWXUQFRPSOHWHO\DURXQGZKHQZHLVVXHFRPPDQGVIURP
WKH%$6,&6WDPS)LOHVDQGRUFXWWKHVWRS WDE RQWKHILQDO JHDUXQWLOLWLV JRQH GRQW VDQG LQWRWKHJHDU
WHHWKPDNLQJVXUHWKHDUHDLVIOXVKRQFHWKHWDELVJRQH7KHWDELVVKRZQLQ)LJXUH
)LJXUH6WRS7DE5HPRYDO
2QFHWKHILQDOJHDUKDVEHHQUHPRYHGIURPWKHVHUYR
FXWRUVDQGWKHVWRSWDERIIWKHSDUWVRWKDWLWPD\
URWDWHIUHHO\7KHDUHDDURXQGWKHVWRSWDEQHHGVWREH
YHU\VPRRWKDQGIUHHRISODVWLFGHEULV

VLJQDOZLOOFDXVHWKHPRWRUWRPRYHWKHRXWSXWVKDIWYLDWKHJHDUVXQWLOWKHHUURUVLJQDOLVZKHQWKHRXWSXW
KDVUHDFKHG,IWKHRXWSXWVKDIWKDGEHHQDWDQHUURUVLJQDORIRSSRVLWHSRODULW\ZRXOGKDYHEHHQ
JHQHUDWHGDQG WKHPRWRU ZRXOGKDYHWXUQHGLQ WKHRULJLQDOGLUHFWLRQ WR EULQJLWEDFNWR  7KHFXUUHQW
SRVLWLRQLVIHGEDFNWRWKHVHUYRVFRQWUROV\VWHPLQDORRSWRPDLQWDLQD]HURHUURUVLJQDO7KHIDUWKHUWKH
SRWHQWLRPHWHULVIURPWKHGHVLUHGSRVLWLRQWKHODUJHUWKHHUURUVLJQDODQGZLWKLQWKHOLPLWVRIWKHPRWRUDQG
HOHFWURQLFVWKHIDVWHUWKHPRWRUWXUQVWREULQJWKHHUURUEDFNWR]HUR
gear teeth
drive plate
metal ring
)LJXUH5HPRYH'ULYH3ODWHIURP%RWWRPRI)LQDO*HDU
7KLVLVWKHERWWRPRIWKHILQDOJHDU3U\RXWWKHPHWDOULQJDQG
UHPRYHWKHSRWHQWLRPHWHUGULYHSODWH5HLQVHUWWKHPHWDOULQJ
ZLWKRXWWKHGULYHSODWH
([SHULPHQW%RH%RW&RQVWUXFWLRQ
3DJH•

5RERWLFV6WXGHQW*XLGH9HUVLRQ
%\UHPRYLQJWKHSRWHQWLRPHWHUGULYHSODWHZHDUHRSHQLQJWKHFRQWUROORRS1RZZKHQZHVHQGDFRPPDQG
WR WKH VHUYR DQ HUURU VLJQDO ZLOO VWLOO EH JHQHUDWHG DFFRUGLQJ WKH GLIIHUHQFH EHWZHHQ WKH FRPPDQG DQG
SRWHQWLRPHWHUSRVLWLRQVEXWVLQFHWKHSRWHQWLRPHWHULVQnWWXUQHGE\WKHRXWSXWVKDIWDQ\PRUHWKHPRWRUZLOO
FRQWLQXHWRUXQDWWKHVDPHVSHHGDVORQJDVFRPPDQGVDUHVHQW,QVXPPDU\WKHPRGLILHGVHUYRZLOOEH
IXQFWLRQLQJDVDYDULDEOHVSHHGJHDUHGPRWRUZLWKDFRQWUROVLJQDOWKDWLVYHU\HDV\IRUWKH%$6,&6WDPSWR
JHQHUDWH
7KH VHUYRV LQWHUQDO SRWHQWLRPHWHU PXVW EH URWDWHG WR EH FHQWHUHG DFFRUGLQJ WR D VLJQDO LW H[SHFWV WR
UHFHLYH IURP WKH %$6,& 6WDPS 7KLV LV GRQH E\ FRQQHFWLQJ WKHVHUYRV WR \RXU %$6,& 6WDPS DQG %RDUG RI
(GXFDWLRQDVVKRZQLQ)LJXUHZKLFKSUHVHQWVWKHVHUYRFDVHLQVWDOOHGIRUFRQYHQLHQFHWKRXJKLWVKRXOG
VWLOOEHUHPRYHGDWWKLVSRLQW6HUYRVKDYHWKUHHZLUHVOHDGLQJIURPWKHEDVHSRZHUJURXQGDQGFRQWURO7KH
FRQWUROOHDGLVXVHGWRVHQGWKHSRVLWLRQLQJVLJQDOWKHRQHFRQQHFWHGWRWKH%$6,&6WDPS,2SLQ
:KHQSUHSDULQJWKLVFLUFXLWQRWHWKDWWKHVHUYRVDUHFRQQHFWHGWRWKH9LQXQUHJXODWHGYROWVWKDWLV
MXPSHUHGIURPWKH$SS0RG&RQQHFWRUWRWKHEUHDGERDUGVHHWKHFRYHUSKRWR7KHUHVDOVRDODUJHX)

’Program Listing 1.1 v1.2
’Program for calibrating servo to its center using BS-2
center: ’establishes a name for this calibration routine
pulsout 15, 750 ’sends a pulse of 1.5 milliseconds to the servo
pause 20 ’delay between pulses is 10 ms to 20 ms
goto center
:KHQWKHFRGHLVUXQQLQJWXUQWKHSRWHQWLRPHWHUVKDIWXQWLOWKHPRWRUVWRSV&KDQJHWKH
pulsout 15,750
WRUHDG
pulsout 3, 750
DQGDGMXVWSRWHQWLRPHWHURQWKHVHFRQGVHUYR
6RZKDWKDYH\RXGRQH"
6HUYRVDUHFRQWUROOHGE\VHQGLQJSXOVHVRIVSHFLILFZLGWKVZKLFKWKHVHUYRHOHFWURQLFVLQWHUSUHWDVSRVLWLRQV
XVLQJDV\VWHPFDOOHG3XOVH:LGWK0RGXODWLRQ3:0,QRUGHUWRXQGHUVWDQGWKLV\RXQHHGWRXQGHUVWDQGWKH
WHUPVPLOOLVHFRQGVPVDQGPLFURVHFRQGVØVPVLVWKRIDVHFRQGRUSXWDQRWKHUZD\WKHUH
DUHPVLQHYHU\VHFRQGØVLVWKRIDVHFRQGRUWKHUHDUHPLOOLRQØVLQHDFKVHFRQG
6HUYRPDQXIDFWXUHUVXVXDOO\VSHFLI\SXOVHZLGWKVLQØVVRLWVKDQG\WREHDEOHWRFRQYHUWEHWZHHQØVDQGPV
7KH VHUYR HOHFWURQLFV DUH GHVLJQHG WR LQWHUSUHW D SRVLWLYHJRLQJ SXOVH ZLWK SHULRG ZLGWK LQ PV EHWZHHQ
DERXWDQGPVDVDSRVLWLRQEHWZHHQDQGGHJUHHVIRUWKHRXWSXWVKDIW:KHQ\RXURWDWHGWKHVKDIW
EDFNDQGIRUWKWKHVHUYRVSRWHQWLRPHWHUZDVFRPSDULQJWKHSXOVHZLGWKYDOXHRIWKLVLVPLOOLVHFRQGV
EHFDXVHWKH
pulsout
FRPPDQGZRUNVLQXQLWVRIXVWRZKDWLWH[SHFWHGWRUHFHLYHIRUWKHSRWHQWLRPHWHUnV
FHQWHUSRVLWLRQDIWHUPRGLILFDWLRQ<RXURWDWHGWKHVKDIWXQWLOWKHWZRYDOXHVZHUHHTXDO$W WKLVSRLQWWKH
PRWRUVWRSSHGWXUQLQJHYHQWKRXJKLWZDVVWLOOUHFHLYLQJSXOVHV
7KHSXOVHVDUHUHSHDWHGDERXWHYHU\PVVRWKDWDQHZFRPSDULVRQFDQEHPDGH7KHPVUHSHWLWLRQ
UDWHLVQRWFULWLFDOEHFDXVHDOORIWKHSRVLWLRQLQIRUPDWLRQLVFDUULHGE\WKHSXOVHOHQJWKLWVHOIEXWWKHVHUYR
ZDVGHVLJQHGWRZRUNZHOOZLWKDQHZSXOVHHYHU\WRPVWRWLPHVVHFRQGRU+]
([SHULPHQW%RH%RW&RQVWUXFWLRQ
3DJH•

5RERWLFV6WXGHQW*XLGH9HUVLRQ
7KHSLFWXUHVLQ)LJXUHVWKURXJKDUHLQFOXGHGZLWKPLOOLPHWHUGLPHQVLRQVLQFDVH\RXZRXOGOLNHWREXLOG
\RXURZQ%RH%RWEDVHRU\RXFDQDOVRGRZQORDGGLPHQVLRQHGGUDZLQJVLQ$GREH3')$XWR&DG';)DQG
$XWR&DG':*ILOHVIURPKWWSZZZVWDPSVLQFODVVFRP
7KH%RH%RWZKHHOVKDYHEHHQPDFKLQHGZLWKDVSOLQHWKDWILWVVQXJO\RQ3DUDOOD[DQG)XWDEDVW\OHVHUYRV
$WWDFKERWKZKHHOVDQGUHSODFHWKHVPDOOEODFNVFUHZWRKROGWKHPRQWRWKHVHUYRV2QFHWKLVLVILQLVKHG\RX
FDQVOLGHWKHUXEEHUWLUHVRYHUWKHZKHHOV
6WHS,QVWDOO7DLO:KHHODQG%DWWHU\+ROGHU
0RXQWWKHWDLOZKHHOXVLQJWKHVXSSOLHGFRWWHUSLQ7KHEDWWHU\KROGHULVDWWDFKHGXVLQJWZRIODWKHDGVFUHZV
DQGQXW,QVWDOOWKHWKUHHJURPPHWVWZRILWLQWKHUHDUKROHVDQGVHUYHDVDEDWWHU\SOXJKROGHUZKHQLWVQRW
SOXJJHGLQWRWKH%RDUGRI(GXFDWLRQDQGRQHPRXQWVLQWKHPLGGOHWRSSDUWRIWKHFKDVVLVZKHUHZLUHVDUH
WKUHDGHGWKURXJKWKHERG\7KHPPFRD[LDO'&SRZHUSOXJVKRXOGEHWKUHDGHGWKURXJKWKHPLGGOHKROH
RIWKH%RH%RWVR\RXFDQFRQQHFWLWWRWKH%RDUGRI(GXFDWLRQ%ULQJDOOZLUHVWKURXJKWKHPLGGOHJURPPHW
KROH)LJXUHVKRZVWKHFRPSOHWHGXQGHUFDUULDJHWKLVSLFWXUHGRHVQRWVKRZWKHPLGGOHKROH
)LJXUH%RH%RW%RWWRP6LGH9LHZ
6HUYRVEDWWHU\SDFNDQGWDLOZKHHOVKRXOGEH
PRXQWHGDWWKLVSRLQW%ULQJWKHZLUHVWRZDUGVWKH
WRSRIWKH%RH%RW7KLV%RH%RWKDVWKHZKHHOV
FORVHVWWRWKHIURQWEXWWKHURERWWXUQVWLJKWHULI
WKH\DUHPRXQWHGLQWKHUHYHUVHIDVKLRQ
([SHULPHQW%RH%RW&RQVWUXFWLRQ
5RERWLFV6WXGHQW*XLGH9HUVLRQ•3DJH 
6WHS0RXQWLQJWKH%RDUGRI(GXFDWLRQDQG&RQQHFWLQJWKH6HUYRV
0RXQW WKH %RDUG RI (GXFDWLRQ %RHSDUW RI %RH%RW RQ WKH URERW FKDVVLV EDVH ZLWK HLJKW  PDFKLQH
VFUHZV DQG VWDQGRIIV 7KH EUHDGERDUG VKRXOG EH FORVHVW WR WKH IURQW RI WKH FKDVVLV FHQWHUHG GLUHFWO\ LQ
EHWZHHQWKHWZRZKHHOV7KLVZLOODOORZVHQVRUVWREHPRXQWHGLQDSRVLWLRQZKHUHWKH\FDQUHVSRQGWRWKH
SK\VLFDOHQYLURQPHQWLQIURQWRIWKH%RH%RW
2QFHWKLVLVGRQHUHFRQQHFWWKHVHUYRVDVVKRZQLQ)LJXUH<RXOOQHHGWRXVHWKHWZRWKUHHSLQSRVWVWR
SOXJ WKH VHUYRV LQWR WKH EUHDGERDUG DQG MXPSHU WKHP RYHU WR 9VV DQG 9LQ 7KH ILQLVKHG %RH%RW VKRXOG
URXJKO\UHVHPEOHWKHRQHVKRZQLQ)LJXUHVWR

< White
< - Black
< + Red
< White
< - Black
([SHULPHQW%RH%RW&RQVWUXFWLRQ
3DJH•

5RERWLFV6WXGHQW*XLGH9HUVLRQ
)LJXUH%RH%RW&RPSOHWHO\$VVHPEOHG
7KHEDVLF%RH%RWLVDVVHPEOHGDQGVHUYRVDUH
FRQQHFWHGWRWKH%RDUGRI(GXFDWLRQGRHVQnWVKRZ
.UHVLVWRUVDQGVHUYRFRQQHFWLRQVWR,2SLQV
)LJXUH%RH%RW)URQW'UDZLQJ
7KHIURQWRI\RXU%RH%RWKDVDIHZKROHVDQGVORWV
ZKHUH\RXZLOOEHDEOHWRPRXQWVHQVRUVRURWKHU
PHFKDQLFDOGHYLFHV
([SHULPHQW%RH%RW&RQVWUXFWLRQ
5RERWLFV6WXGHQW*XLGH9HUVLRQ•3DJH 
)LJXUH%RH%RW7RS'UDZLQJ
1RWHWKDWWKHVHUYRVDUHSODFHGZLWKWKHZKHHOV
FORVHVWWRWKHFHQWHURIWKHURERW7KLVPDNHVWXUQV
YHU\WLJKWDQGUHGXFHVIULFWLRQRQWKHUHDUZKHHO
)LJXUH%RH%RW6LGH'UDZLQJ
7KHEUHDGERDUGRQWKH%RDUGRI(GXFDWLRQLV
PRXQWHGWRZDUGVWKHIURQWRIWKH%RH%RW
:HOOEHEXLOGLQJRXUSURMHFWVRQWKLV
EUHDGERDUG
([SHULPHQW%RH%RW&RQVWUXFWLRQ
3DJH•

pulsout
YDOXHVRIDQG6LQFHZHVHWWKHVHUYRWRVWRSPRYLQJ
ZLWKD FRPPDQGRIDQ\VKRUWHUSXOVH WKDQ WKLVZLOOFDXVH WKH VHUYR WRURWDWH FORFNZLVHDQGORQJHU
YDOXHVZLOOURWDWHFRXQWHUFORFNZLVH%HFDXVHRQHVHUYRLVUHYHUVHGZKHQWKH\DUHXVHGDVDGULYHWUDLQRQHLV
SXOVHGWKHRSSRVLWHGLUHFWLRQWRPDNHWKHURERWPRYHIRUZDUGRUEDFNZDUGV7KHYDOXHRIWKH
for. . next
ORRSLVSURSRUWLRQDOWRWKHGLVWDQFHWKH%RH%RWWUDYHOVWKHVSHFLILHGGLUHFWLRQ
([SHULPHQW%RH%RW&RQVWUXFWLRQ
5RERWLFV6WXGHQW*XLGH9HUVLRQ•3DJH 
([SHULPHQW%RH%RW&RQVWUXFWLRQ
3DJH•

5RERWLFV6WXGHQW*XLGH9HUVLRQ
&KDOOHQJH
3URJUDPWKH%RH%RWWRPRYHLQVHYHUDOGLIIHUHQWSDWWHUQV7U\WKHIROORZLQJ
D 7RPRYHVWUDLJKWIRUZDUGRUEDFNZDUGZHXVHGGLIIHUHQWSXOVHOHQJWKVIRUHDFKVHUYR:KDWKDSSHQVLI
ERWKVHUYRVDUHVHQWWKHVDPHSXOVHOHQJWK"
E ,GHQWLI\
pulsout
YDOXHVWKDWPDNHWKH%RH%RWPRYHIRUZDUGYHU\VORZO\WKHQEDFNZDUGVYHU\VORZO\LQ
DVWUDLJKWOLQH
F 0DNHDJUDSKRIZKHHOVSHHGDVDIXQFWLRQRISXOVHOHQJWKIRUHDFKVHUYR
+LQWV
• 8VHVHYHUDOSXOVHOHQJWKVEHWZHHQDQGPVSXOVRXWYDOXHVEHWZHHQDQG
• (LWKHUFRXQWKRZPDQ\UHYROXWLRQVWKHZKHHOFRPSOHWHVLQDVSHFLILHGWLPHVHFRUDPLQXWHRU
VHHKRZPXFKWLPHLWWDNHVWRFRPSOHWHUHYROXWLRQV
<RXUJUDSKPLJKWORRNVRPHWKLQJOLNHWKLV
-50.0
-40.0
-30.0

$XWRQRPRXVPRELOHURERWVGHFLGHWRPRYHEDVHGRQWKHGDWDWKH\UHFHLYHIURPWKHLULQSXWGHYLFHVLQWKH
FDVHRIWKH%RH%RWWKLVLQFOXGHVLQIUDUHGVHQVRUVSKRWRUHVLVWRUVDQGDQ\RWKHUVHQVRUVWKDW\RXGHFLGHWR
DGG
7KLVH[SHULPHQWLV DOO DERXW %$6,& SURJUDPPLQJ DV LW SHUWDLQV WR VLPSOH PRYHPHQW ZLWKRXW VHQVRU LQSXW
6WUXFWXULQJ\RXU SURJUDP VR WKH%RH%RWPRYHV DV \RX LQWHQGUHTXLUHVDQXQGHUVWDQGLQJRI KRZWRMXPS
EHWZHHQVXEURXWLQHODEHOVUHDGPRYHPHQWSDWWHUQVIURPDQ((3520GHWHUPLQHKRZIDUWRWUDYHODQGKRZ
WRJHWEDFNWR\RXUVWDUWLQJSRLQWSK\VLFDOO\DQGZLWKLQ\RXUVRXUFHFRGH([SHULPHQWLQJDQGPDNLQJDOORI
WKHVHGHFLVLRQVZLOOEHPDGHZLWKRXWWKHKHOSRIDQLQSXWVHQVRU
,QPDQ\H[SHULPHQWVZHXVHGWKH
debug
VWDWHPHQWWRYLHZWKHYDOXHRIYDULDEOHVFDOFXODWHGE\WKH%$6,&
6WDPS7KH
debug
VWDWHPHQWVHQGVWKHGDWDWR\RXU3&VFUHHQSULPDULO\WRGHWHUPLQHLIZHUHJHWWLQJWKH
UHVXOWVZHH[SHFWHG:LWKWKH%RH%RWXVLQJ
debug
EHFRPHVDELWPRUHFRPSOH[VLQFH\RXUURERWLVXVXDOO\
UHDG\WRUROORQFHDSURJUDPLVGRZQORDGHG7KHUHDUHWZRWULFNVZHOOXVHWRRYHUFRPHWKLVSUREOHP DQG
YHULI\WKDWRXUFRGHLVZRUNLQJSURSHUO\
 6WDQG WKH%RH%RWRQLWV)URQW&KDVVLVVRWKDWLWGRHVQnWPRYH7KHIURQWRIWKH%RH%RWLV IODW
DOORZLQJ\RXWRVWDQGLWRQLWVXSYHUWLFDOO\WRSUHYHQWWKHZKHHOVIURPWRXFKLQJWKHVXUIDFHRI\RXU
GHVN7KHVHULDOFDEOHFDQUHPDLQFRQQHFWHGWRWKH%RDUGRI(GXFDWLRQV '%FRQQHFWRUVRWKDW
\RXFDQXVHWKHGHEXJFRPPDQG
 /('VDQG3LH]RVSHDNHU/('VFDQSURYLGHYLVXDOIHHGEDFNWRKHOSHYDOXDWHWKHIXQFWLRQDOLW\RI\RXU
VRXUFHFRGH$3LH]RVSHDNHUZLOOEHXVHGWRJHQHUDWHXQLTXHVRXQGVWKDWFRUUHVSRQGWRSDUWLFXODU
PRYHPHQWV 
7KH/('V DQG SLH]RVSHDNHU ZLOO DGG VRPH LQWHUHVWLQJ RXWSXW GHYLFHV WR \RXU %RH%RW 8VH WKHVH IHHGEDFN
PHFKDQLVPVWRJLYHLQIRUPDWLRQDERXWZKDW\RXUURERWLVGRLQJ.HHSLQPLQGWKDWDURERWGRHVQWQHHGWR
PLPLF KXPDQ EHKDYLRU 'HHS VSDFH SUREHV DXWRPRELOH DVVHPEO\ OLQH URERWV WKDW SDLQW DQG ZHOG DQG
DXWRPDWHG RIILFH PDLO GHOLYHU\ V\VWHPV DUH JRRG H[DPSOHV RI UHDO ZRUOG URERW DSSOLFDWLRQV 7KH\ DFFHSW

left_servo con 15
right_servo con 3
x var word
pause 2000
for x = 850 to 650 ’begin of routine
pulsout left_servo,x ’pulse width of 1500 us
pulsout right_servo,1500-x ’pulse width of 1500 us
pause 20 ’pause for 20 ms
next