Styresystem for kybernetisk håndleddsprotese - NTNU
Styresystem for kybernetisk håndleddsprotese - NTNU
Styresystem for kybernetisk håndleddsprotese - NTNU
You also want an ePaper? Increase the reach of your titles
YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.
Kapittel 5. Moduldesign 30<br />
Motorstrøm Strømmåling<br />
VCC<br />
R1<br />
1ohm<br />
R2<br />
10Kohm<br />
C2<br />
100nF<br />
3<br />
2<br />
8<br />
4<br />
R5<br />
6K8ohm<br />
U1:A<br />
1<br />
MCP602<br />
R4<br />
100Kohm<br />
R3<br />
100Kohm<br />
C1<br />
10uF<br />
5<br />
6<br />
8<br />
4<br />
U1:B<br />
7<br />
MCP602<br />
R6<br />
100Kohm<br />
R7<br />
84K5ohm<br />
U2<br />
1<br />
1A<br />
2<br />
1B<br />
3<br />
2Y<br />
VCC<br />
1Y<br />
2B<br />
2A<br />
SN74VC2G02<br />
7<br />
6<br />
5<br />
Transistor Av/På<br />
Set (SR-vippe)<br />
Interrupt ved overstrøm<br />
Figur 5.6: Kretsskjema <strong>for</strong> strømovervåkningsmodulen. Operasjons<strong>for</strong>sterkerene finnes<br />
på samme brikke, og SR-vippa bygges opp av to NOR-porter.<br />
gi maksimal oppløsning. Ved å velge motstandsverdier på 100kΩ og 6,8kΩ, fås en<br />
<strong>for</strong>sterkning på:<br />
A<strong>for</strong>sterker = 1 + 100 · 103Ω 6, 8 · 103 ≈ 15, 7<br />
Ω<br />
Verdien ut fra <strong>for</strong>sterkeren kan så sendes til mikrokontrollerens interne AD-<br />
omsetter <strong>for</strong> å bli brukt i momentreguleringen.<br />
Hadde det vært nok å bruke programvare <strong>for</strong> å hindre overoppheting av mo-<br />
toren, kunne vi stoppet her. Men siden dette skal gjøres av maskinvaren må<br />
strømmålingen behandles videre. Neste skritt er å sende målingen inn på positiv<br />
inngang på en komparator hvor den sammenlignes med en spenning tilsvarende<br />
maksimalt tillatt motorstrøm. Denne kan finnes ved hjelp av ligning 5.2 som gir<br />
maksimal motorstrøm til å være 145mA. Se utregning lenger ned. Dette tilsvarer<br />
en spenning ut fra <strong>for</strong>sterkeren på:<br />
0, 145A · 1Ω · A<strong>for</strong>sterker = 2, 28V<br />
Med en spenningsdeling mellom motstandere på R6 = 100kΩ og R7 = 84,5kΩ,<br />
fås en referansespenning på 2,29V. Ved å sette denne inn på komparatorens ne-<br />
gative inngang, kan vi når motorstrømmen blir <strong>for</strong> høy få generert et interrupt<br />
til mikrokontrolleren <strong>for</strong> å si ifra om at motoren slås av. Det samme signalet<br />
brukes til å resette en SR-vippe hvis utgang er koblet til transistoren i motor-