/*SwitchInit*/ //setup front switch and back switch pin //enable digital capacity //set to input //set as internal pull down /*FrontSwitchChecker*/ //create static variable to check switch reading //If the state of the input line has changed //If the current state of the input line is HIGH, switch has pull down //PostEvent FrontCollision with parameter of the state //Else (current input state is low), no longer contacting the wall no action //Set LastInputState to CurrentInputState /*ReverseSwitchChecker*/ //create static variable to check switch reading //If the state of the input line has changed //If the current state of the input line is HIGH, switch has pull down //PostEvent ReverseCollision with parameter of the state //Else (current input state is low), no longer contacting the wall no action //Set LastInputState to CurrentInputState