Index: uspace/drv/char/i8042/i8042.c
===================================================================
--- uspace/drv/char/i8042/i8042.c	(revision cd1cc4e69812ba2c63ccbb1fed0ac27868c3c577)
+++ uspace/drv/char/i8042/i8042.c	(revision 02aad10abf57ac8e48510670cf6898df7b332787)
@@ -307,10 +307,11 @@
 	
 	for (size_t i = 0; i < size; ++i) {
-		wait_ready(controller);
-		
-		if (controller->aux_fun == fun)
+		if (controller->aux_fun == fun) {
+			wait_ready(controller);
 			pio_write_8(&controller->regs->status,
 			    i8042_CMD_WRITE_AUX);
+		}
 		
+		wait_ready(controller);
 		pio_write_8(&controller->regs->data, buffer[i]);
 	}