Energy Consumption Model for Manipulators