1 /* 2 * Smart reflex Class 3 specific implementations 3 * 4 * Author: Thara Gopinath <thara@ti.com> 5 * 6 * Copyright (C) 2010 Texas Instruments, Inc. 7 * Thara Gopinath <thara@ti.com> 8 * 9 * This program is free software; you can redistribute it and/or modify 10 * it under the terms of the GNU General Public License version 2 as 11 * published by the Free Software Foundation. 12 */ 13 14 #include <linux/power/smartreflex.h> 15 #include "soc.h" 16 #include "voltage.h" 17 18 static int sr_class3_enable(struct omap_sr *sr) 19 { 20 unsigned long volt = voltdm_get_voltage(sr->voltdm); 21 22 if (!volt) { 23 pr_warn("%s: Curr voltage unknown. Cannot enable %s\n", 24 __func__, sr->name); 25 return -ENODATA; 26 } 27 28 omap_vp_enable(sr->voltdm); 29 return sr_enable(sr, volt); 30 } 31 32 static int sr_class3_disable(struct omap_sr *sr, int is_volt_reset) 33 { 34 sr_disable_errgen(sr); 35 omap_vp_disable(sr->voltdm); 36 sr_disable(sr); 37 if (is_volt_reset) 38 voltdm_reset(sr->voltdm); 39 40 return 0; 41 } 42 43 static int sr_class3_configure(struct omap_sr *sr) 44 { 45 return sr_configure_errgen(sr); 46 } 47 48 /* SR class3 structure */ 49 static struct omap_sr_class_data class3_data = { 50 .enable = sr_class3_enable, 51 .disable = sr_class3_disable, 52 .configure = sr_class3_configure, 53 .class_type = SR_CLASS3, 54 }; 55 56 /* Smartreflex Class3 init API to be called from board file */ 57 static int __init sr_class3_init(void) 58 { 59 pr_info("SmartReflex Class3 initialized\n"); 60 return sr_register_class(&class3_data); 61 } 62 omap_late_initcall(sr_class3_init); 63