Update test_code/i2c_seven_segment/main.cpp

Moved some code.