1*71e2f4ddSJiaxun Yang // SPDX-License-Identifier: GPL-2.0-or-later 2*71e2f4ddSJiaxun Yang /* 3*71e2f4ddSJiaxun Yang * Lemote loongson2f family machines' specific suspend support 4*71e2f4ddSJiaxun Yang * 5*71e2f4ddSJiaxun Yang * Copyright (C) 2009 Lemote Inc. 6*71e2f4ddSJiaxun Yang * Author: Wu Zhangjin <wuzhangjin@gmail.com> 7*71e2f4ddSJiaxun Yang */ 8*71e2f4ddSJiaxun Yang 9*71e2f4ddSJiaxun Yang #include <linux/suspend.h> 10*71e2f4ddSJiaxun Yang #include <linux/interrupt.h> 11*71e2f4ddSJiaxun Yang #include <linux/pm.h> 12*71e2f4ddSJiaxun Yang #include <linux/i8042.h> 13*71e2f4ddSJiaxun Yang #include <linux/export.h> 14*71e2f4ddSJiaxun Yang 15*71e2f4ddSJiaxun Yang #include <asm/i8259.h> 16*71e2f4ddSJiaxun Yang #include <asm/mipsregs.h> 17*71e2f4ddSJiaxun Yang #include <asm/bootinfo.h> 18*71e2f4ddSJiaxun Yang 19*71e2f4ddSJiaxun Yang #include <loongson.h> 20*71e2f4ddSJiaxun Yang 21*71e2f4ddSJiaxun Yang #include <cs5536/cs5536_mfgpt.h> 22*71e2f4ddSJiaxun Yang #include "ec_kb3310b.h" 23*71e2f4ddSJiaxun Yang 24*71e2f4ddSJiaxun Yang #define I8042_KBD_IRQ 1 25*71e2f4ddSJiaxun Yang #define I8042_CTR_KBDINT 0x01 26*71e2f4ddSJiaxun Yang #define I8042_CTR_KBDDIS 0x10 27*71e2f4ddSJiaxun Yang 28*71e2f4ddSJiaxun Yang static unsigned char i8042_ctr; 29*71e2f4ddSJiaxun Yang 30*71e2f4ddSJiaxun Yang static int i8042_enable_kbd_port(void) 31*71e2f4ddSJiaxun Yang { 32*71e2f4ddSJiaxun Yang if (i8042_command(&i8042_ctr, I8042_CMD_CTL_RCTR)) { 33*71e2f4ddSJiaxun Yang pr_err("i8042.c: Can't read CTR while enabling i8042 kbd port." 34*71e2f4ddSJiaxun Yang "\n"); 35*71e2f4ddSJiaxun Yang return -EIO; 36*71e2f4ddSJiaxun Yang } 37*71e2f4ddSJiaxun Yang 38*71e2f4ddSJiaxun Yang i8042_ctr &= ~I8042_CTR_KBDDIS; 39*71e2f4ddSJiaxun Yang i8042_ctr |= I8042_CTR_KBDINT; 40*71e2f4ddSJiaxun Yang 41*71e2f4ddSJiaxun Yang if (i8042_command(&i8042_ctr, I8042_CMD_CTL_WCTR)) { 42*71e2f4ddSJiaxun Yang i8042_ctr &= ~I8042_CTR_KBDINT; 43*71e2f4ddSJiaxun Yang i8042_ctr |= I8042_CTR_KBDDIS; 44*71e2f4ddSJiaxun Yang pr_err("i8042.c: Failed to enable KBD port.\n"); 45*71e2f4ddSJiaxun Yang 46*71e2f4ddSJiaxun Yang return -EIO; 47*71e2f4ddSJiaxun Yang } 48*71e2f4ddSJiaxun Yang 49*71e2f4ddSJiaxun Yang return 0; 50*71e2f4ddSJiaxun Yang } 51*71e2f4ddSJiaxun Yang 52*71e2f4ddSJiaxun Yang void setup_wakeup_events(void) 53*71e2f4ddSJiaxun Yang { 54*71e2f4ddSJiaxun Yang int irq_mask; 55*71e2f4ddSJiaxun Yang 56*71e2f4ddSJiaxun Yang switch (mips_machtype) { 57*71e2f4ddSJiaxun Yang case MACH_LEMOTE_ML2F7: 58*71e2f4ddSJiaxun Yang case MACH_LEMOTE_YL2F89: 59*71e2f4ddSJiaxun Yang /* open the keyboard irq in i8259A */ 60*71e2f4ddSJiaxun Yang outb((0xff & ~(1 << I8042_KBD_IRQ)), PIC_MASTER_IMR); 61*71e2f4ddSJiaxun Yang irq_mask = inb(PIC_MASTER_IMR); 62*71e2f4ddSJiaxun Yang 63*71e2f4ddSJiaxun Yang /* enable keyboard port */ 64*71e2f4ddSJiaxun Yang i8042_enable_kbd_port(); 65*71e2f4ddSJiaxun Yang 66*71e2f4ddSJiaxun Yang /* Wakeup CPU via SCI lid open event */ 67*71e2f4ddSJiaxun Yang outb(irq_mask & ~(1 << PIC_CASCADE_IR), PIC_MASTER_IMR); 68*71e2f4ddSJiaxun Yang inb(PIC_MASTER_IMR); 69*71e2f4ddSJiaxun Yang outb(0xff & ~(1 << (SCI_IRQ_NUM - 8)), PIC_SLAVE_IMR); 70*71e2f4ddSJiaxun Yang inb(PIC_SLAVE_IMR); 71*71e2f4ddSJiaxun Yang 72*71e2f4ddSJiaxun Yang break; 73*71e2f4ddSJiaxun Yang 74*71e2f4ddSJiaxun Yang default: 75*71e2f4ddSJiaxun Yang break; 76*71e2f4ddSJiaxun Yang } 77*71e2f4ddSJiaxun Yang } 78*71e2f4ddSJiaxun Yang 79*71e2f4ddSJiaxun Yang static struct delayed_work lid_task; 80*71e2f4ddSJiaxun Yang static int initialized; 81*71e2f4ddSJiaxun Yang /* yeeloong_report_lid_status will be implemented in yeeloong_laptop.c */ 82*71e2f4ddSJiaxun Yang sci_handler yeeloong_report_lid_status; 83*71e2f4ddSJiaxun Yang EXPORT_SYMBOL(yeeloong_report_lid_status); 84*71e2f4ddSJiaxun Yang static void yeeloong_lid_update_task(struct work_struct *work) 85*71e2f4ddSJiaxun Yang { 86*71e2f4ddSJiaxun Yang if (yeeloong_report_lid_status) 87*71e2f4ddSJiaxun Yang yeeloong_report_lid_status(BIT_LID_DETECT_ON); 88*71e2f4ddSJiaxun Yang } 89*71e2f4ddSJiaxun Yang 90*71e2f4ddSJiaxun Yang int wakeup_loongson(void) 91*71e2f4ddSJiaxun Yang { 92*71e2f4ddSJiaxun Yang int irq; 93*71e2f4ddSJiaxun Yang 94*71e2f4ddSJiaxun Yang /* query the interrupt number */ 95*71e2f4ddSJiaxun Yang irq = mach_i8259_irq(); 96*71e2f4ddSJiaxun Yang if (irq < 0) 97*71e2f4ddSJiaxun Yang return 0; 98*71e2f4ddSJiaxun Yang 99*71e2f4ddSJiaxun Yang printk(KERN_INFO "%s: irq = %d\n", __func__, irq); 100*71e2f4ddSJiaxun Yang 101*71e2f4ddSJiaxun Yang if (irq == I8042_KBD_IRQ) 102*71e2f4ddSJiaxun Yang return 1; 103*71e2f4ddSJiaxun Yang else if (irq == SCI_IRQ_NUM) { 104*71e2f4ddSJiaxun Yang int ret, sci_event; 105*71e2f4ddSJiaxun Yang /* query the event number */ 106*71e2f4ddSJiaxun Yang ret = ec_query_seq(CMD_GET_EVENT_NUM); 107*71e2f4ddSJiaxun Yang if (ret < 0) 108*71e2f4ddSJiaxun Yang return 0; 109*71e2f4ddSJiaxun Yang sci_event = ec_get_event_num(); 110*71e2f4ddSJiaxun Yang if (sci_event < 0) 111*71e2f4ddSJiaxun Yang return 0; 112*71e2f4ddSJiaxun Yang if (sci_event == EVENT_LID) { 113*71e2f4ddSJiaxun Yang int lid_status; 114*71e2f4ddSJiaxun Yang /* check the LID status */ 115*71e2f4ddSJiaxun Yang lid_status = ec_read(REG_LID_DETECT); 116*71e2f4ddSJiaxun Yang /* wakeup cpu when people open the LID */ 117*71e2f4ddSJiaxun Yang if (lid_status == BIT_LID_DETECT_ON) { 118*71e2f4ddSJiaxun Yang /* If we call it directly here, the WARNING 119*71e2f4ddSJiaxun Yang * will be sent out by getnstimeofday 120*71e2f4ddSJiaxun Yang * via "WARN_ON(timekeeping_suspended);" 121*71e2f4ddSJiaxun Yang * because we can not schedule in suspend mode. 122*71e2f4ddSJiaxun Yang */ 123*71e2f4ddSJiaxun Yang if (initialized == 0) { 124*71e2f4ddSJiaxun Yang INIT_DELAYED_WORK(&lid_task, 125*71e2f4ddSJiaxun Yang yeeloong_lid_update_task); 126*71e2f4ddSJiaxun Yang initialized = 1; 127*71e2f4ddSJiaxun Yang } 128*71e2f4ddSJiaxun Yang schedule_delayed_work(&lid_task, 1); 129*71e2f4ddSJiaxun Yang return 1; 130*71e2f4ddSJiaxun Yang } 131*71e2f4ddSJiaxun Yang } 132*71e2f4ddSJiaxun Yang } 133*71e2f4ddSJiaxun Yang 134*71e2f4ddSJiaxun Yang return 0; 135*71e2f4ddSJiaxun Yang } 136*71e2f4ddSJiaxun Yang 137*71e2f4ddSJiaxun Yang void __weak mach_suspend(void) 138*71e2f4ddSJiaxun Yang { 139*71e2f4ddSJiaxun Yang disable_mfgpt0_counter(); 140*71e2f4ddSJiaxun Yang } 141*71e2f4ddSJiaxun Yang 142*71e2f4ddSJiaxun Yang void __weak mach_resume(void) 143*71e2f4ddSJiaxun Yang { 144*71e2f4ddSJiaxun Yang enable_mfgpt0_counter(); 145*71e2f4ddSJiaxun Yang } 146