static int set_powered(struct ofono_modem *modem, ofono_bool_t powered)
{
const struct ofono_modem_driver *driver = modem->driver;
int err = -EINVAL;
if (modem->powered_pending == powered)
return -EALREADY;
/* Remove the atoms even if the driver is no longer available */
if (powered == FALSE)
modem_change_state(modem, MODEM_STATE_POWER_OFF);
modem->powered_pending = powered;
if (driver == NULL)
return -EINVAL;
if (powered == TRUE) {
if (driver->enable)
err = driver->enable(modem);
} else {
if (driver->disable)
err = driver->disable(modem);
}
if (err == 0) {
modem->powered = powered;
notify_powered_watches(modem);
} else if (err != -EINPROGRESS)
modem->powered_pending = modem->powered;
return err;
}
static gboolean set_powered_timeout(gpointer user)
{
struct ofono_modem *modem = user;
DBG("modem: %p", modem);
modem->timeout = 0;
if (modem->powered_pending == FALSE) {
DBusConnection *conn = ofono_dbus_get_connection();
dbus_bool_t powered = FALSE;
set_online(modem, FALSE);
modem->powered = FALSE;
notify_powered_watches(modem);
ofono_dbus_signal_property_changed(conn, modem->path,
OFONO_MODEM_INTERFACE,
"Powered", DBUS_TYPE_BOOLEAN,
&powered);
} else {
modem->powered_pending = modem->powered;
}
if (modem->pending != NULL) {
DBusMessage *reply;
reply = __ofono_error_timed_out(modem->pending);
__ofono_dbus_pending_reply(&modem->pending, reply);
if (modem->lockdown)
lockdown_remove(modem);
}
return FALSE;
}
void ofono_modem_set_powered(struct ofono_modem *modem, ofono_bool_t powered)
{
DBusConnection *conn = ofono_dbus_get_connection();
dbus_bool_t dbus_powered = powered;
if (modem->timeout > 0) {
g_source_remove(modem->timeout);
modem->timeout = 0;
}
if (modem->powered_pending != modem->powered &&
modem->pending != NULL) {
DBusMessage *reply;
if (powered == modem->powered_pending)
reply = dbus_message_new_method_return(modem->pending);
else
reply = __ofono_error_failed(modem->pending);
__ofono_dbus_pending_reply(&modem->pending, reply);
}
modem->powered_pending = powered;
if (modem->powered == powered)
goto out;
modem->powered = powered;
notify_powered_watches(modem);
if (modem->lockdown)
ofono_dbus_signal_property_changed(conn, modem->path,
OFONO_MODEM_INTERFACE,
"Lockdown", DBUS_TYPE_BOOLEAN,
&modem->lockdown);
if (modem->driver == NULL) {
ofono_error("Calling ofono_modem_set_powered on a"
"modem with no driver is not valid, "
"please fix the modem driver.");
return;
}
ofono_dbus_signal_property_changed(conn, modem->path,
OFONO_MODEM_INTERFACE,
"Powered", DBUS_TYPE_BOOLEAN,
&dbus_powered);
if (powered) {
modem_change_state(modem, MODEM_STATE_PRE_SIM);
/* Force SIM Ready for devices with no sim atom */
if (modem_has_sim(modem) == FALSE)
sim_state_watch(OFONO_SIM_STATE_READY, modem);
} else {
set_online(modem, FALSE);
modem_change_state(modem, MODEM_STATE_POWER_OFF);
}
out:
if (powering_down && powered == FALSE) {
modems_remaining -= 1;
if (modems_remaining == 0)
__ofono_exit();
}
}
