The integration of the auxiliary power module (APM) functionality into non-dissipative balancing hardware of a high voltage battery or supercapacitor pack enables a more cost-effective non-dissipative balancing system while maintaining a similar complexity in topologies. The system uses state-space equations and three control problems to balance high-voltage energy storage elements and charge low voltage energy storage elements. Two optimization based controllers are employed to optimize both balancing and charging simultaneously.