1b5f87f15SMartin Schwidefsky /* 2b5f87f15SMartin Schwidefsky * Idle functions for s390. 3b5f87f15SMartin Schwidefsky * 4b5f87f15SMartin Schwidefsky * Copyright IBM Corp. 2014 5b5f87f15SMartin Schwidefsky * 6b5f87f15SMartin Schwidefsky * Author(s): Martin Schwidefsky <schwidefsky@de.ibm.com> 7b5f87f15SMartin Schwidefsky */ 8b5f87f15SMartin Schwidefsky 9b5f87f15SMartin Schwidefsky #include <linux/kernel.h> 10b5f87f15SMartin Schwidefsky #include <linux/kernel_stat.h> 11b5f87f15SMartin Schwidefsky #include <linux/kprobes.h> 12b5f87f15SMartin Schwidefsky #include <linux/notifier.h> 13b5f87f15SMartin Schwidefsky #include <linux/init.h> 14b5f87f15SMartin Schwidefsky #include <linux/cpu.h> 15b5f87f15SMartin Schwidefsky #include <asm/cputime.h> 16b5f87f15SMartin Schwidefsky #include <asm/nmi.h> 17b5f87f15SMartin Schwidefsky #include <asm/smp.h> 18b5f87f15SMartin Schwidefsky #include "entry.h" 19b5f87f15SMartin Schwidefsky 20b5f87f15SMartin Schwidefsky static DEFINE_PER_CPU(struct s390_idle_data, s390_idle); 21b5f87f15SMartin Schwidefsky 22b5f87f15SMartin Schwidefsky void __kprobes enabled_wait(void) 23b5f87f15SMartin Schwidefsky { 24*0429fbc0SLinus Torvalds struct s390_idle_data *idle = this_cpu_ptr(&s390_idle); 25b5f87f15SMartin Schwidefsky unsigned long long idle_time; 26b5f87f15SMartin Schwidefsky unsigned long psw_mask; 27b5f87f15SMartin Schwidefsky 28b5f87f15SMartin Schwidefsky trace_hardirqs_on(); 29b5f87f15SMartin Schwidefsky 30b5f87f15SMartin Schwidefsky /* Wait for external, I/O or machine check interrupt. */ 31b5f87f15SMartin Schwidefsky psw_mask = PSW_KERNEL_BITS | PSW_MASK_WAIT | PSW_MASK_DAT | 32b5f87f15SMartin Schwidefsky PSW_MASK_IO | PSW_MASK_EXT | PSW_MASK_MCHECK; 33b5f87f15SMartin Schwidefsky clear_cpu_flag(CIF_NOHZ_DELAY); 34b5f87f15SMartin Schwidefsky 35b5f87f15SMartin Schwidefsky /* Call the assembler magic in entry.S */ 36b5f87f15SMartin Schwidefsky psw_idle(idle, psw_mask); 37b5f87f15SMartin Schwidefsky 38b5f87f15SMartin Schwidefsky /* Account time spent with enabled wait psw loaded as idle time. */ 39b5f87f15SMartin Schwidefsky idle->sequence++; 40b5f87f15SMartin Schwidefsky smp_wmb(); 41b5f87f15SMartin Schwidefsky idle_time = idle->clock_idle_exit - idle->clock_idle_enter; 42b5f87f15SMartin Schwidefsky idle->clock_idle_enter = idle->clock_idle_exit = 0ULL; 43b5f87f15SMartin Schwidefsky idle->idle_time += idle_time; 44b5f87f15SMartin Schwidefsky idle->idle_count++; 45b5f87f15SMartin Schwidefsky account_idle_time(idle_time); 46b5f87f15SMartin Schwidefsky smp_wmb(); 47b5f87f15SMartin Schwidefsky idle->sequence++; 48b5f87f15SMartin Schwidefsky } 49b5f87f15SMartin Schwidefsky 50b5f87f15SMartin Schwidefsky static ssize_t show_idle_count(struct device *dev, 51b5f87f15SMartin Schwidefsky struct device_attribute *attr, char *buf) 52b5f87f15SMartin Schwidefsky { 53b5f87f15SMartin Schwidefsky struct s390_idle_data *idle = &per_cpu(s390_idle, dev->id); 54b5f87f15SMartin Schwidefsky unsigned long long idle_count; 55b5f87f15SMartin Schwidefsky unsigned int sequence; 56b5f87f15SMartin Schwidefsky 57b5f87f15SMartin Schwidefsky do { 58b5f87f15SMartin Schwidefsky sequence = ACCESS_ONCE(idle->sequence); 59b5f87f15SMartin Schwidefsky idle_count = ACCESS_ONCE(idle->idle_count); 60b5f87f15SMartin Schwidefsky if (ACCESS_ONCE(idle->clock_idle_enter)) 61b5f87f15SMartin Schwidefsky idle_count++; 62b5f87f15SMartin Schwidefsky } while ((sequence & 1) || (ACCESS_ONCE(idle->sequence) != sequence)); 63b5f87f15SMartin Schwidefsky return sprintf(buf, "%llu\n", idle_count); 64b5f87f15SMartin Schwidefsky } 65b5f87f15SMartin Schwidefsky DEVICE_ATTR(idle_count, 0444, show_idle_count, NULL); 66b5f87f15SMartin Schwidefsky 67b5f87f15SMartin Schwidefsky static ssize_t show_idle_time(struct device *dev, 68b5f87f15SMartin Schwidefsky struct device_attribute *attr, char *buf) 69b5f87f15SMartin Schwidefsky { 70b5f87f15SMartin Schwidefsky struct s390_idle_data *idle = &per_cpu(s390_idle, dev->id); 71b5f87f15SMartin Schwidefsky unsigned long long now, idle_time, idle_enter, idle_exit; 72b5f87f15SMartin Schwidefsky unsigned int sequence; 73b5f87f15SMartin Schwidefsky 74b5f87f15SMartin Schwidefsky do { 75b5f87f15SMartin Schwidefsky now = get_tod_clock(); 76b5f87f15SMartin Schwidefsky sequence = ACCESS_ONCE(idle->sequence); 77b5f87f15SMartin Schwidefsky idle_time = ACCESS_ONCE(idle->idle_time); 78b5f87f15SMartin Schwidefsky idle_enter = ACCESS_ONCE(idle->clock_idle_enter); 79b5f87f15SMartin Schwidefsky idle_exit = ACCESS_ONCE(idle->clock_idle_exit); 80b5f87f15SMartin Schwidefsky } while ((sequence & 1) || (ACCESS_ONCE(idle->sequence) != sequence)); 81b5f87f15SMartin Schwidefsky idle_time += idle_enter ? ((idle_exit ? : now) - idle_enter) : 0; 82b5f87f15SMartin Schwidefsky return sprintf(buf, "%llu\n", idle_time >> 12); 83b5f87f15SMartin Schwidefsky } 84b5f87f15SMartin Schwidefsky DEVICE_ATTR(idle_time_us, 0444, show_idle_time, NULL); 85b5f87f15SMartin Schwidefsky 86b5f87f15SMartin Schwidefsky cputime64_t arch_cpu_idle_time(int cpu) 87b5f87f15SMartin Schwidefsky { 88b5f87f15SMartin Schwidefsky struct s390_idle_data *idle = &per_cpu(s390_idle, cpu); 89b5f87f15SMartin Schwidefsky unsigned long long now, idle_enter, idle_exit; 90b5f87f15SMartin Schwidefsky unsigned int sequence; 91b5f87f15SMartin Schwidefsky 92b5f87f15SMartin Schwidefsky do { 93b5f87f15SMartin Schwidefsky now = get_tod_clock(); 94b5f87f15SMartin Schwidefsky sequence = ACCESS_ONCE(idle->sequence); 95b5f87f15SMartin Schwidefsky idle_enter = ACCESS_ONCE(idle->clock_idle_enter); 96b5f87f15SMartin Schwidefsky idle_exit = ACCESS_ONCE(idle->clock_idle_exit); 97b5f87f15SMartin Schwidefsky } while ((sequence & 1) || (ACCESS_ONCE(idle->sequence) != sequence)); 98b5f87f15SMartin Schwidefsky return idle_enter ? ((idle_exit ?: now) - idle_enter) : 0; 99b5f87f15SMartin Schwidefsky } 100b5f87f15SMartin Schwidefsky 101b5f87f15SMartin Schwidefsky void arch_cpu_idle_enter(void) 102b5f87f15SMartin Schwidefsky { 103b5f87f15SMartin Schwidefsky local_mcck_disable(); 104b5f87f15SMartin Schwidefsky } 105b5f87f15SMartin Schwidefsky 106b5f87f15SMartin Schwidefsky void arch_cpu_idle(void) 107b5f87f15SMartin Schwidefsky { 108b5f87f15SMartin Schwidefsky if (!test_cpu_flag(CIF_MCCK_PENDING)) 109b5f87f15SMartin Schwidefsky /* Halt the cpu and keep track of cpu time accounting. */ 110b5f87f15SMartin Schwidefsky enabled_wait(); 111b5f87f15SMartin Schwidefsky local_irq_enable(); 112b5f87f15SMartin Schwidefsky } 113b5f87f15SMartin Schwidefsky 114b5f87f15SMartin Schwidefsky void arch_cpu_idle_exit(void) 115b5f87f15SMartin Schwidefsky { 116b5f87f15SMartin Schwidefsky local_mcck_enable(); 117b5f87f15SMartin Schwidefsky if (test_cpu_flag(CIF_MCCK_PENDING)) 118b5f87f15SMartin Schwidefsky s390_handle_mcck(); 119b5f87f15SMartin Schwidefsky } 120b5f87f15SMartin Schwidefsky 121b5f87f15SMartin Schwidefsky void arch_cpu_idle_dead(void) 122b5f87f15SMartin Schwidefsky { 123b5f87f15SMartin Schwidefsky cpu_die(); 124b5f87f15SMartin Schwidefsky } 125