Source Code Optimization and Profiling of Energy Consumption in Embedded Systems