- #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;
- }
- }
- }