Stap 8: Code voor rolstoel!!
/*
*
*
*
*
*/
#define m11 5
#define m12 6
#define m21 10
#define m22 11
#define D0 3
#define D1 4
#define D2 7
#define D3 8
VOID vooruit()
{
digitalWrite (m11, laag);
digitalWrite (m12, hoge);
digitalWrite (m21, hoge);
digitalWrite (m22, laag);
}
VOID backward()
{
digitalWrite (m11, hoge);
digitalWrite (m12, laag);
digitalWrite (m21, laag);
digitalWrite (m22, hoge);
}
VOID datumwaarde
{
digitalWrite (m11, hoge);
digitalWrite (m12, hoge);
digitalWrite (m21, hoge);
digitalWrite (m22, laag);
}
VOID rechts()
{
digitalWrite (m11, laag);
digitalWrite (m12, hoge);
digitalWrite (m21, hoge);
digitalWrite (m22, hoge);
}
VOID Stop()
{
digitalWrite (m11, hoge);
digitalWrite (m12, hoge);
digitalWrite (m21, hoge);
digitalWrite (m22, hoge);
}
VOID Setup
{
pinMode (D0, INPUT);
pinMode (D1, INPUT);
pinMode (D2, INPUT);
pinMode (D3, INPUT);
pinMode (m11, OUTPUT);
pinMode (m12, OUTPUT);
pinMode (m21, OUTPUT);
pinMode (m22, OUTPUT);
}
void loop
{
int temp1=digitalRead(D0);
int temp2=digitalRead(D1);
int temp3=digitalRead(D2);
int temp4=digitalRead(D3);
Als (temp1 == 0 & & temp2 == 1 & & temp3 == 1 & & temp4 == 0)
vooruit();
anders als (temp1 == 0 & & temp2 == 0 & & temp3 == 0 & &
temp4 == 1)
datumwaarde;
anders als (temp1 == 0 & & temp2 == 1 & & temp3 == 1 & &
temp4 == 1)
rechts();
anders als (temp1 == 1 & & temp2 == 0 & & temp3 == 0 & &
temp4 == 1)
backward();
anders als (temp1 == 1 & & temp2 == 1 & & temp3 == 1 & &
temp4 == 1)
Stop();
}