modified main function for testing the SERVO_I2C class