04.09.2013 Views

Styresystem for kybernetisk håndleddsprotese - NTNU

Styresystem for kybernetisk håndleddsprotese - NTNU

Styresystem for kybernetisk håndleddsprotese - NTNU

SHOW MORE
SHOW LESS

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-

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!