Finished testing code for HBridge breadboard.