static int clevo_mail_led_blink(struct led_classdev *led_cdev, unsigned long *delay_on, unsigned long *delay_off) { int status = -EINVAL; if (*delay_on == 0 /* ms */ && *delay_off == 0 /* ms */) { /* Special case: the leds subsystem requested us to * chose one user friendly blinking of the LED, and * start it. Let's blink the led slowly (0.5Hz). */ *delay_on = 1000; /* ms */ *delay_off = 1000; /* ms */ i8042_command(NULL, CLEVO_MAIL_LED_BLINK_0_5HZ); status = 0; } else if (*delay_on == 500 /* ms */ && *delay_off == 500 /* ms */) { /* blink the led with 1Hz */ i8042_command(NULL, CLEVO_MAIL_LED_BLINK_1HZ); status = 0; } else if (*delay_on == 1000 /* ms */ && *delay_off == 1000 /* ms */) { /* blink the led with 0.5Hz */ i8042_command(NULL, CLEVO_MAIL_LED_BLINK_0_5HZ); status = 0; } else { printk(KERN_DEBUG KBUILD_MODNAME ": clevo_mail_led_blink(..., %lu, %lu)," " returning -EINVAL (unsupported)\n", *delay_on, *delay_off); } return status; }
static void clevo_mail_led_set(struct led_classdev *led_cdev, enum led_brightness value) { if (value == LED_OFF) i8042_command(NULL, CLEVO_MAIL_LED_OFF); else if (value <= LED_HALF) i8042_command(NULL, CLEVO_MAIL_LED_BLINK_0_5HZ); else i8042_command(NULL, CLEVO_MAIL_LED_BLINK_1HZ); }
static int amilo_a1655_rfkill_set_block(void *data, bool blocked) { u8 param = blocked ? A1655_WIFI_OFF : A1655_WIFI_ON; int rc; i8042_lock_chip(); rc = i8042_command(¶m, A1655_WIFI_COMMAND); i8042_unlock_chip(); return rc; }
static int i8042_enable_kbd_port(void) { if (i8042_command(&i8042_ctr, I8042_CMD_CTL_RCTR)) { pr_err("i8042.c: Can't read CTR while enabling i8042 kbd port." "\n"); return -EIO; } i8042_ctr &= ~I8042_CTR_KBDDIS; i8042_ctr |= I8042_CTR_KBDINT; if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR)) { i8042_ctr &= ~I8042_CTR_KBDINT; i8042_ctr |= I8042_CTR_KBDDIS; pr_err("i8042.c: Failed to enable KBD port.\n"); return -EIO; } return 0; }
/* * Enable auxiliary device and interrupt. */ void i8042_aux_enable () { /* Disable AUX port. */ outb (KBDC_DISAUX, KBDC_AT_CTL); /* Send enable command to AUX device. It will reply with ACK. */ i8042_aux_write (KBDK_ENABLE); /* Enable keyboard and AUX port. */ i8042_command (KBCB_ENINTR | KBCB_AUXINTR | KBCB_SYSFLG | KBCB_TRANSL); }
static int samsungq10_bl_set_intensity(struct backlight_device *bd) { int brightness = bd->props.brightness; unsigned char c[3] = SAMSUNGQ10_BL_8042_DATA; c[2] = (unsigned char)brightness; i8042_lock_chip(); i8042_command(c, (0x30 << 8) | SAMSUNGQ10_BL_8042_CMD); i8042_unlock_chip(); samsungq10_bl_brightness = brightness; return 0; }
static void keyboard_init(void *data) { /* flush incoming keys */ int ret = i8042_flush(); if (ret) return; // Controller self-test. u8 param[2]; ret = i8042_command(I8042_CMD_CTL_TEST, param); if (ret) return; if (param[0] != 0x55) { dprintf(1, "i8042 self test failed (got %x not 0x55)\n", param[0]); return; } // Controller keyboard test. ret = i8042_command(I8042_CMD_KBD_TEST, param); if (ret) return; if (param[0] != 0x00) { dprintf(1, "i8042 keyboard test failed (got %x not 0x00)\n", param[0]); return; } // Disable keyboard and mouse events. SET_EBDA(ps2ctr, I8042_CTR_KBDDIS | I8042_CTR_AUXDIS); /* ------------------- keyboard side ------------------------*/ /* reset keyboard and self test (keyboard side) */ ret = ps2_kbd_command(ATKBD_CMD_RESET_BAT, param); if (ret) return; if (param[0] != 0xaa) { dprintf(1, "keyboard self test failed (got %x not 0xaa)\n", param[0]); return; } /* Disable keyboard */ ret = ps2_kbd_command(ATKBD_CMD_RESET_DIS, NULL); if (ret) return; // Set scancode command (mode 2) param[0] = 0x02; ret = ps2_kbd_command(ATKBD_CMD_SSCANSET, param); if (ret) return; // Keyboard Mode: disable mouse, scan code convert, enable kbd IRQ SET_EBDA(ps2ctr, I8042_CTR_AUXDIS | I8042_CTR_XLATE | I8042_CTR_KBDINT); /* Enable keyboard */ ret = ps2_kbd_command(ATKBD_CMD_ENABLE, NULL); if (ret) return; dprintf(1, "PS2 keyboard initialized\n"); }
static int __ps2_command(int aux, int command, u8 *param) { int ret2; int receive = (command >> 8) & 0xf; int send = (command >> 12) & 0xf; // Disable interrupts and keyboard/mouse. u8 ps2ctr = GET_EBDA(ps2ctr); u8 newctr = ((ps2ctr | I8042_CTR_AUXDIS | I8042_CTR_KBDDIS) & ~(I8042_CTR_KBDINT|I8042_CTR_AUXINT)); dprintf(6, "i8042 ctr old=%x new=%x\n", ps2ctr, newctr); int ret = i8042_command(I8042_CMD_CTL_WCTR, &newctr); if (ret) return ret; // Flush any interrupts already pending. yield(); // Enable port command is being sent to. if (aux) newctr &= ~I8042_CTR_AUXDIS; else newctr &= ~I8042_CTR_KBDDIS; ret = i8042_command(I8042_CMD_CTL_WCTR, &newctr); if (ret) goto fail; if (command == ATKBD_CMD_RESET_BAT) { // Reset is special wrt timeouts and bytes received. // Send command. ret = ps2_sendbyte(aux, command, 1000); if (ret) goto fail; // Receive parameters. ret = ps2_recvbyte(aux, 0, 4000); if (ret < 0) goto fail; param[0] = ret; ret = ps2_recvbyte(aux, 0, 100); if (ret < 0) // Some devices only respond with one byte on reset. ret = 0; param[1] = ret; } else if (command == ATKBD_CMD_GETID) { // Getid is special wrt bytes received. // Send command. ret = ps2_sendbyte(aux, command, 200); if (ret) goto fail; // Receive parameters. ret = ps2_recvbyte(aux, 0, 500); if (ret < 0) goto fail; param[0] = ret; if (ret == 0xab || ret == 0xac || ret == 0x2b || ret == 0x5d || ret == 0x60 || ret == 0x47) { // These ids (keyboards) return two bytes. ret = ps2_recvbyte(aux, 0, 500); if (ret < 0) goto fail; param[1] = ret; } else { param[1] = 0; } } else { // Send command. ret = ps2_sendbyte(aux, command, 200); if (ret) goto fail; // Send parameters (if any). int i; for (i = 0; i < send; i++) { ret = ps2_sendbyte(aux, param[i], 200); if (ret) goto fail; } // Receive parameters (if any). for (i = 0; i < receive; i++) { ret = ps2_recvbyte(aux, 0, 500); if (ret < 0) goto fail; param[i] = ret; } } ret = 0; fail: // Restore interrupts and keyboard/mouse. ret2 = i8042_command(I8042_CMD_CTL_WCTR, &ps2ctr); if (ret2) return ret2; return ret; }
static int i8042_aux_write(u8 c) { return i8042_command(I8042_CMD_AUX_SEND, &c); }
static int ps2_command(int aux, int command, u8 *param) { int ret2; int receive = (command >> 8) & 0xf; int send = (command >> 12) & 0xf; // Disable interrupts and keyboard/mouse. u8 ps2ctr = GET_EBDA(ps2ctr); u8 newctr = ps2ctr; if (aux) newctr |= I8042_CTR_KBDDIS; else newctr |= I8042_CTR_AUXDIS; newctr &= ~(I8042_CTR_KBDINT|I8042_CTR_AUXINT); dprintf(6, "i8042 ctr old=%x new=%x\n", ps2ctr, newctr); int ret = i8042_command(I8042_CMD_CTL_WCTR, &newctr); if (ret) return ret; if (command == ATKBD_CMD_RESET_BAT) { // Reset is special wrt timeouts. // Send command. ret = ps2_sendbyte(aux, command, 1000); if (ret) goto fail; // Receive parameters. ret = ps2_recvbyte(aux, 0, 4000); if (ret < 0) goto fail; param[0] = ret; ret = ps2_recvbyte(aux, 0, 100); if (ret < 0) // Some devices only respond with one byte on reset. ret = 0; param[1] = ret; } else { // Send command. ret = ps2_sendbyte(aux, command, 200); if (ret) goto fail; // Send parameters (if any). int i; for (i = 0; i < send; i++) { ret = ps2_sendbyte(aux, param[i], 200); if (ret) goto fail; } // Receive parameters (if any). for (i = 0; i < receive; i++) { ret = ps2_recvbyte(aux, 0, 500); if (ret < 0) goto fail; param[i] = ret; } } ret = 0; fail: // Restore interrupts and keyboard/mouse. ret2 = i8042_command(I8042_CMD_CTL_WCTR, &ps2ctr); if (ret2) return ret2; return ret; }
/* * Enable keyboard device and interrupt. */ void i8042_kbd_enable () { /* Enable keyboard and AUX port. */ i8042_command (KBCB_ENINTR | KBCB_AUXINTR | KBCB_SYSFLG | KBCB_TRANSL); }