Index: uspace/drv/char/i8042/i8042.c
===================================================================
--- uspace/drv/char/i8042/i8042.c	(revision 2df6f6fe4f21b8f1ebefce19a6d94cd3137976f0)
+++ uspace/drv/char/i8042/i8042.c	(revision 60db8525f04f5e9caea3389ef78b705ef8a76368)
@@ -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]);
 	}