Optimized Code Size by modified i2c cpal code