Schematic
Code
</syntaxhighlight>#include<reg51.h> #define Motors P2#define Switches P1#define Forward 0x05#define Backward 0x0a#define Left 0x06#define Right 0x09#define stop 0x00void main(){ unsigned char SwitchInput; Switches = 0x0f; //Configure Switches as Input Motors = 0X00; //Configure both Motors as Output. while(1) { SwitchInput = (0x0f & Switches); //read switch status and mask lower byte. switch(SwitchInput) { case 1: Motors = Forward; break; case 2: Motors = Backward; break; case 4: Motors = Left; break; case 8: Motors = Right; break; default: Motors =stop; } }} <\syntaxhighlight>