Energy Analysis Code:
// Reset motor direction
reverse(4);
// Run all motors at 25 power for 4 seconds
motorSpeed(4,25);
goFor(4);
// Stop all motors and continue running the program for 10 seconds to ensure all data is collected
motorSpeed(4,0);
goFor(10);