Modeling and Optimization of Energy Consumption in Cooperative Multi-Robot Systems