blob: ec48d87f5f1c6e13f326fd9b161be015055ece06 [file] [log] [blame]
Norman James26072c02015-08-25 07:14:29 -05001#include <stdint.h>
2#include <stdio.h>
3#include <stdlib.h>
4#include <string.h>
5#include <fcntl.h>
6#include <unistd.h>
7#include <sys/stat.h>
8#include <sys/mman.h>
Norman James8abb50c2015-09-16 10:58:16 -05009#include <syslog.h>
Norman James362a80f2015-09-14 14:04:39 -050010#include "interfaces/openbmc_intf.h"
Norman James10ff6a32015-08-27 14:24:17 -050011#include "openbmc.h"
12#include "gpio.h"
Norman Jamese2765102015-08-19 22:00:55 -050013
14/* ---------------------------------------------------------------------------------------------------- */
Norman James362a80f2015-09-14 14:04:39 -050015static const gchar* dbus_object_path = "/org/openbmc/control";
Norman James26072c02015-08-25 07:14:29 -050016static const gchar* dbus_name = "org.openbmc.control.Power";
17
Norman James32e74e22015-09-15 21:28:06 -050018//This object will use these GPIOs
Norman James3f97c5d2015-08-26 17:44:14 -050019GPIO power_pin = (GPIO){ "POWER_PIN" };
20GPIO pgood = (GPIO){ "PGOOD" };
Norman Jamese2765102015-08-19 22:00:55 -050021
22static GDBusObjectManagerServer *manager = NULL;
Norman Jamese2765102015-08-19 22:00:55 -050023
Norman James88872672015-09-21 16:51:35 -050024time_t pgood_timeout_start = 0;
Norman James362a80f2015-09-14 14:04:39 -050025
Norman James3d3b7fb2015-10-06 16:54:06 -050026// TODO: Change to interrupt driven instead of polling
Norman Jamesce46e3e2015-08-30 22:25:55 -050027static gboolean poll_pgood(gpointer user_data)
28{
29 ControlPower *control_power = object_get_control_power((Object*)user_data);
30 Control* control = object_get_control((Object*)user_data);
Norman Jamesbd4abd12015-09-16 22:43:46 -050031
32 //send the heartbeat
Norman Jamesce46e3e2015-08-30 22:25:55 -050033 control_emit_heartbeat(control,dbus_name);
Norman James32e74e22015-09-15 21:28:06 -050034 const gchar* obj_path = g_dbus_object_get_object_path((GDBusObject*)user_data);
Norman Jamesce46e3e2015-08-30 22:25:55 -050035
Norman James6a1283c2015-09-16 22:21:11 -050036 guint poll_int = control_get_poll_interval(control);
37 if (poll_int == 0)
38 {
Norman James2891c532015-10-06 08:01:56 -050039 printf("ERROR PowerControl: Poll interval cannot be 0\n");
Norman James6a1283c2015-09-16 22:21:11 -050040 return FALSE;
41 }
Norman James88872672015-09-21 16:51:35 -050042 //handle timeout
43 time_t current_time = time(NULL);
44 if (difftime(current_time,pgood_timeout_start) > control_power_get_pgood_timeout(control_power)
45 && pgood_timeout_start != 0)
Norman James32e74e22015-09-15 21:28:06 -050046 {
Norman James2891c532015-10-06 08:01:56 -050047 printf("ERROR PowerControl: Pgood poll timeout\n");
Norman Jamesbd4abd12015-09-16 22:43:46 -050048 // set timeout to 0 so timeout doesn't happen again
Norman James32e74e22015-09-15 21:28:06 -050049 control_power_set_pgood_timeout(control_power,0);
Norman James88872672015-09-21 16:51:35 -050050 pgood_timeout_start = 0;
Norman James8abb50c2015-09-16 10:58:16 -050051 return TRUE;
Norman James32e74e22015-09-15 21:28:06 -050052 }
Norman James32e74e22015-09-15 21:28:06 -050053 uint8_t gpio;
Norman James88872672015-09-21 16:51:35 -050054
55 int rc = gpio_open(&pgood);
56 rc = gpio_read(&pgood,&gpio);
57 gpio_close(&pgood);
Norman James32e74e22015-09-15 21:28:06 -050058 if (rc == GPIO_OK)
Norman James362a80f2015-09-14 14:04:39 -050059 {
Norman James32e74e22015-09-15 21:28:06 -050060 //if changed, set property and emit signal
61 if (gpio != control_power_get_pgood(control_power))
62 {
63 control_power_set_pgood(control_power,gpio);
64 if (gpio==0)
65 {
66 control_power_emit_power_lost(control_power);
67 control_emit_goto_system_state(control,"POWERED_OFF");
68 }
69 else
70 {
71 control_power_emit_power_good(control_power);
72 control_emit_goto_system_state(control,"POWERED_ON");
73 }
74 }
75 } else {
Norman James2891c532015-10-06 08:01:56 -050076 printf("ERROR PowerControl: GPIO read error (gpio=%s,rc=%d)\n",pgood.name,rc);
Norman James32e74e22015-09-15 21:28:06 -050077 }
78 //pgood is not at desired state yet
79 if (gpio != control_power_get_state(control_power) &&
Norman James88872672015-09-21 16:51:35 -050080 control_power_get_pgood_timeout(control_power) > 0)
Norman James32e74e22015-09-15 21:28:06 -050081 {
Norman James88872672015-09-21 16:51:35 -050082 if (pgood_timeout_start == 0 ) {
83 pgood_timeout_start = current_time;
84 }
Norman James32e74e22015-09-15 21:28:06 -050085 }
86 else
87 {
Norman James88872672015-09-21 16:51:35 -050088 pgood_timeout_start = 0;
Norman James362a80f2015-09-14 14:04:39 -050089 }
Norman Jamesce46e3e2015-08-30 22:25:55 -050090 return TRUE;
91}
92
93
94
Norman Jamese2765102015-08-19 22:00:55 -050095static gboolean
Norman James3f97c5d2015-08-26 17:44:14 -050096on_set_power_state (ControlPower *pwr,
Norman Jamese2765102015-08-19 22:00:55 -050097 GDBusMethodInvocation *invocation,
98 guint state,
99 gpointer user_data)
100{
Norman James362a80f2015-09-14 14:04:39 -0500101 Control* control = object_get_control((Object*)user_data);
Norman James32e74e22015-09-15 21:28:06 -0500102 const gchar* obj_path = g_dbus_object_get_object_path((GDBusObject*)user_data);
Norman James3f97c5d2015-08-26 17:44:14 -0500103 if (state > 1)
104 {
105 g_dbus_method_invocation_return_dbus_error (invocation,
106 "org.openbmc.ControlPower.Error.Failed",
107 "Invalid power state");
108 return TRUE;
109 }
Norman James9e6acf92015-09-08 07:00:04 -0500110 // return from method call
111 control_power_complete_set_power_state(pwr,invocation);
Norman James3f97c5d2015-08-26 17:44:14 -0500112 if (state == control_power_get_state(pwr))
113 {
Norman James9e6acf92015-09-08 07:00:04 -0500114 g_print("Power already at requested state: %d\n",state);
Norman James3f97c5d2015-08-26 17:44:14 -0500115 }
Norman James9e6acf92015-09-08 07:00:04 -0500116 else
117 {
Norman James32e74e22015-09-15 21:28:06 -0500118 int error = 0;
119 do {
Norman James19e45912015-10-04 20:19:41 -0500120 if (state == 1) {
121 control_emit_goto_system_state(control,"POWERING_ON");
122 } else {
123 control_emit_goto_system_state(control,"POWERING_OFF");
124 }
Norman James32e74e22015-09-15 21:28:06 -0500125 error = gpio_open(&power_pin);
Norman James88872672015-09-21 16:51:35 -0500126 if (error != GPIO_OK) { break; }
Norman James32e74e22015-09-15 21:28:06 -0500127 error = gpio_write(&power_pin,!state);
Norman James88872672015-09-21 16:51:35 -0500128 if (error != GPIO_OK) { break; }
Norman James32e74e22015-09-15 21:28:06 -0500129 gpio_close(&power_pin);
130 control_power_set_state(pwr,state);
Norman James32e74e22015-09-15 21:28:06 -0500131 } while(0);
132 if (error != GPIO_OK)
Norman James362a80f2015-09-14 14:04:39 -0500133 {
Norman James2891c532015-10-06 08:01:56 -0500134 printf("ERROR PowerControl: GPIO set power state (rc=%d)\n",error);
Norman James362a80f2015-09-14 14:04:39 -0500135 }
Norman James9e6acf92015-09-08 07:00:04 -0500136 }
137 return TRUE;
138}
Norman Jamese2765102015-08-19 22:00:55 -0500139
Norman James9e6acf92015-09-08 07:00:04 -0500140static gboolean
141on_init (Control *control,
142 GDBusMethodInvocation *invocation,
143 gpointer user_data)
144{
Norman James88872672015-09-21 16:51:35 -0500145 pgood_timeout_start = 0;
Norman James9e6acf92015-09-08 07:00:04 -0500146 guint poll_interval = control_get_poll_interval(control);
147 g_timeout_add(poll_interval, poll_pgood, user_data);
148 control_complete_init(control,invocation);
Norman James3f97c5d2015-08-26 17:44:14 -0500149 return TRUE;
Norman Jamese2765102015-08-19 22:00:55 -0500150}
151
152static gboolean
Norman James3f97c5d2015-08-26 17:44:14 -0500153on_get_power_state (ControlPower *pwr,
Norman Jamese2765102015-08-19 22:00:55 -0500154 GDBusMethodInvocation *invocation,
155 gpointer user_data)
156{
Norman James3f97c5d2015-08-26 17:44:14 -0500157 guint pgood = control_power_get_pgood(pwr);
158 control_power_complete_get_power_state(pwr,invocation,pgood);
159 return TRUE;
Norman Jamese2765102015-08-19 22:00:55 -0500160}
161
162static void
163on_bus_acquired (GDBusConnection *connection,
164 const gchar *name,
165 gpointer user_data)
166{
Norman James3f97c5d2015-08-26 17:44:14 -0500167 ObjectSkeleton *object;
Norman James10ff6a32015-08-27 14:24:17 -0500168 cmdline *cmd = user_data;
169 if (cmd->argc < 2)
170 {
171 g_print("No objects created. Put object name(s) on command line\n");
172 return;
173 }
174 manager = g_dbus_object_manager_server_new (dbus_object_path);
Norman James88872672015-09-21 16:51:35 -0500175 gchar *s;
176 s = g_strdup_printf ("%s/%s",dbus_object_path,cmd->argv[1]);
177 g_print("%s\n",s);
178 object = object_skeleton_new (s);
179 g_free (s);
Norman Jamese2765102015-08-19 22:00:55 -0500180
Norman James88872672015-09-21 16:51:35 -0500181 ControlPower* control_power = control_power_skeleton_new ();
182 object_skeleton_set_control_power (object, control_power);
183 g_object_unref (control_power);
184
185 Control* control = control_skeleton_new ();
186 object_skeleton_set_control (object, control);
187 g_object_unref (control);
Norman Jamese2765102015-08-19 22:00:55 -0500188
Norman James88872672015-09-21 16:51:35 -0500189 //define method callbacks here
190 g_signal_connect (control_power,
191 "handle-set-power-state",
192 G_CALLBACK (on_set_power_state),
193 object); /* user_data */
Norman Jamesce46e3e2015-08-30 22:25:55 -0500194
Norman James88872672015-09-21 16:51:35 -0500195 g_signal_connect (control_power,
196 "handle-get-power-state",
197 G_CALLBACK (on_get_power_state),
198 NULL); /* user_data */
Norman Jamese2765102015-08-19 22:00:55 -0500199
Norman James88872672015-09-21 16:51:35 -0500200 g_signal_connect (control,
201 "handle-init",
202 G_CALLBACK (on_init),
203 object); /* user_data */
Norman James9e6acf92015-09-08 07:00:04 -0500204
205
Norman James88872672015-09-21 16:51:35 -0500206 /* Export the object (@manager takes its own reference to @object) */
207 g_dbus_object_manager_server_export (manager, G_DBUS_OBJECT_SKELETON (object));
208 g_object_unref (object);
Norman Jamesce46e3e2015-08-30 22:25:55 -0500209
Norman James3f97c5d2015-08-26 17:44:14 -0500210 /* Export all objects */
211 g_dbus_object_manager_server_set_connection (manager, connection);
212
213 // get gpio device paths
Norman Jamesbd4abd12015-09-16 22:43:46 -0500214 int rc = GPIO_OK;
Norman James32e74e22015-09-15 21:28:06 -0500215 do {
Norman James32e74e22015-09-15 21:28:06 -0500216 rc = gpio_init(connection,&power_pin);
217 if (rc != GPIO_OK) { break; }
218 rc = gpio_init(connection,&pgood);
219 if (rc != GPIO_OK) { break; }
Norman James65a295a2015-09-26 22:21:10 -0500220 uint8_t gpio;
Norman James32e74e22015-09-15 21:28:06 -0500221 rc = gpio_open(&pgood);
Norman James65a295a2015-09-26 22:21:10 -0500222 if (rc != GPIO_OK) { break; }
223 rc = gpio_read(&pgood,&gpio);
224 if (rc != GPIO_OK) { break; }
225 gpio_close(&pgood);
226 control_power_set_pgood(control_power,gpio);
Norman James32e74e22015-09-15 21:28:06 -0500227 } while(0);
Norman Jamesbd4abd12015-09-16 22:43:46 -0500228 if (rc != GPIO_OK)
229 {
Norman James2891c532015-10-06 08:01:56 -0500230 printf("ERROR PowerControl: GPIO setup (rc=%d)\n",rc);
Norman James65a295a2015-09-26 22:21:10 -0500231 }
Norman Jamese2765102015-08-19 22:00:55 -0500232}
233
234static void
235on_name_acquired (GDBusConnection *connection,
236 const gchar *name,
237 gpointer user_data)
238{
Norman Jamese2765102015-08-19 22:00:55 -0500239}
240
241static void
242on_name_lost (GDBusConnection *connection,
243 const gchar *name,
244 gpointer user_data)
245{
Norman Jamese2765102015-08-19 22:00:55 -0500246}
247
Norman Jamese2765102015-08-19 22:00:55 -0500248
Norman James3f97c5d2015-08-26 17:44:14 -0500249
250
251/*----------------------------------------------------------------*/
252/* Main Event Loop */
253
Norman Jamese2765102015-08-19 22:00:55 -0500254gint
255main (gint argc, gchar *argv[])
256{
257 GMainLoop *loop;
Norman James90caa3c2015-08-27 21:28:48 -0500258 cmdline cmd;
259 cmd.argc = argc;
260 cmd.argv = argv;
Norman Jamese2765102015-08-19 22:00:55 -0500261
262 guint id;
Norman Jamese2765102015-08-19 22:00:55 -0500263 loop = g_main_loop_new (NULL, FALSE);
264
Norman James5e792e32015-10-07 17:36:17 -0500265 id = g_bus_own_name (DBUS_TYPE,
Norman James26072c02015-08-25 07:14:29 -0500266 dbus_name,
Norman Jamese2765102015-08-19 22:00:55 -0500267 G_BUS_NAME_OWNER_FLAGS_ALLOW_REPLACEMENT |
268 G_BUS_NAME_OWNER_FLAGS_REPLACE,
269 on_bus_acquired,
270 on_name_acquired,
271 on_name_lost,
Norman James90caa3c2015-08-27 21:28:48 -0500272 &cmd,
Norman Jamese2765102015-08-19 22:00:55 -0500273 NULL);
274
Norman Jamesce46e3e2015-08-30 22:25:55 -0500275 g_main_loop_run (loop);
Norman Jamese2765102015-08-19 22:00:55 -0500276
277 g_bus_unown_name (id);
278 g_main_loop_unref (loop);
279 return 0;
280}