H Bridge Motor Controller Arduino Code