MPI_Request send_str(std::string message, int to_whom)
{
// If there is an outstanding message to the
// current thread, retrieve it first
int my_rank;
MPI_Comm_rank(MPI_COMM_WORLD, &my_rank);
while (is_message()) {
msg_backlog.push_back(get_str(MPI_ANY_SOURCE, true));
}
MPI_Request request;
MPI_Issend((char*)message.c_str(), message.size(),
MPI_CHAR, to_whom, 0, MPI_COMM_WORLD, &request);
return request;
}
static void
on_sensor_value_notify(IsSensor *sensor,
GParamSpec *pspec,
gpointer user_data)
{
IsMaxPlugin *self;
IsMaxPluginPrivate *priv;
gdouble value;
self = IS_MAX_PLUGIN(user_data);
priv = self->priv;
value = is_sensor_get_value(sensor);
if (value - IS_SENSOR_VALUE_UNSET <= DBL_EPSILON)
{
is_debug("max", "sensor value for sensor %s is unset - ignoring",
is_sensor_get_label(sensor));
goto exit;
}
if (value > priv->max_value && sensor != priv->max)
{
// let's see if we can get away without taking a reference on sensor
priv->max = sensor;
is_message("max", "New highest value sensor: %s (value %f)",
is_sensor_get_label(sensor), value);
}
if (sensor == priv->max)
{
priv->max_value = value;
update_sensor_from_max(self);
}
exit:
return;
}
enum crmd_fsa_state
s_crmd_fsa(enum crmd_fsa_cause cause)
{
fsa_data_t *fsa_data = NULL;
long long register_copy = fsa_input_register;
long long new_actions = A_NOTHING;
enum crmd_fsa_state last_state;
crm_trace("FSA invoked with Cause: %s\tState: %s",
fsa_cause2string(cause), fsa_state2string(fsa_state));
fsa_dump_actions(fsa_actions, "Initial");
do_fsa_stall = FALSE;
if (is_message() == FALSE && fsa_actions != A_NOTHING) {
/* fake the first message so we can get into the loop */
fsa_data = calloc(1, sizeof(fsa_data_t));
fsa_data->fsa_input = I_NULL;
fsa_data->fsa_cause = C_FSA_INTERNAL;
fsa_data->origin = __FUNCTION__;
fsa_data->data_type = fsa_dt_none;
fsa_message_queue = g_list_append(fsa_message_queue, fsa_data);
fsa_data = NULL;
}
while (is_message() && do_fsa_stall == FALSE) {
crm_trace("Checking messages (%d remaining)", g_list_length(fsa_message_queue));
fsa_data = get_message();
if(fsa_data == NULL) {
continue;
}
log_fsa_input(fsa_data);
/* add any actions back to the queue */
fsa_actions |= fsa_data->actions;
fsa_dump_actions(fsa_data->actions, "Restored actions");
/* get the next batch of actions */
new_actions = crmd_fsa_actions[fsa_data->fsa_input][fsa_state];
fsa_actions |= new_actions;
fsa_dump_actions(new_actions, "New actions");
if (fsa_data->fsa_input != I_NULL && fsa_data->fsa_input != I_ROUTER) {
crm_debug("Processing %s: [ state=%s cause=%s origin=%s ]",
fsa_input2string(fsa_data->fsa_input),
fsa_state2string(fsa_state),
fsa_cause2string(fsa_data->fsa_cause), fsa_data->origin);
}
/* logging : *before* the state is changed */
if (is_set(fsa_actions, A_ERROR)) {
do_fsa_action(fsa_data, A_ERROR, do_log);
}
if (is_set(fsa_actions, A_WARN)) {
do_fsa_action(fsa_data, A_WARN, do_log);
}
if (is_set(fsa_actions, A_LOG)) {
do_fsa_action(fsa_data, A_LOG, do_log);
}
/* update state variables */
last_state = fsa_state;
fsa_state = crmd_fsa_state[fsa_data->fsa_input][fsa_state];
/*
* Remove certain actions during shutdown
*/
if (fsa_state == S_STOPPING || ((fsa_input_register & R_SHUTDOWN) == R_SHUTDOWN)) {
clear_bit(fsa_actions, startup_actions);
}
/*
* Hook for change of state.
* Allows actions to be added or removed when entering a state
*/
if (last_state != fsa_state) {
fsa_actions = do_state_transition(fsa_actions, last_state, fsa_state, fsa_data);
} else {
do_dot_log(DOT_PREFIX "\t// FSA input: State=%s \tCause=%s"
" \tInput=%s \tOrigin=%s() \tid=%d",
fsa_state2string(fsa_state),
fsa_cause2string(fsa_data->fsa_cause),
fsa_input2string(fsa_data->fsa_input), fsa_data->origin, fsa_data->id);
}
/* start doing things... */
s_crmd_fsa_actions(fsa_data);
delete_fsa_input(fsa_data);
fsa_data = NULL;
}
if (g_list_length(fsa_message_queue) > 0 || fsa_actions != A_NOTHING || do_fsa_stall) {
crm_debug("Exiting the FSA: queue=%d, fsa_actions=0x%llx, stalled=%s",
g_list_length(fsa_message_queue), fsa_actions, do_fsa_stall ? "true" : "false");
} else {
crm_trace("Exiting the FSA");
}
/* cleanup inputs? */
if (register_copy != fsa_input_register) {
long long same = register_copy & fsa_input_register;
fsa_dump_inputs(LOG_DEBUG, "Added", fsa_input_register ^ same);
fsa_dump_inputs(LOG_DEBUG, "Removed", register_copy ^ same);
}
fsa_dump_actions(fsa_actions, "Remaining");
fsa_dump_queue(LOG_DEBUG);
return fsa_state;
}
/**
* @brief: c UART0 IRQ Handler
*/
void uart_iprocess(void)
{
uint8_t IIR_IntId; // Interrupt ID from IIR
LPC_UART_TypeDef *pUart = (LPC_UART_TypeDef *)LPC_UART0;
__disable_irq();
#ifdef DEBUG_0
//uart1_put_string("Entering c_UART0_IRQHandler\n\r");
#endif // DEBUG_0
/* Reading IIR automatically acknowledges the interrupt */
IIR_IntId = (pUart->IIR) >> 1 ; // skip pending bit in IIR
if (IIR_IntId & IIR_RDA) { // Receive Data Avaialbe
/* read UART. Read RBR will clear the interrupt */
// Perform a 'context switch'
PCB *old_proc = gp_current_process;
gp_current_process = k_get_process(PID_UART_IPROC);
g_char_in = pUart->RBR;
#ifdef DEBUG_0
uart1_put_string("Reading a char = ");
uart1_put_char(g_char_in);
uart1_put_string("\n\r");
#endif // DEBUG_0
// process the character. If it is a hotkey, call the corresponding function
// If we are reading, fall through to default and add to the command buffer
switch (g_char_in) {
case '\r':
case '\n':
if (g_is_reading) {
// We've finished reading a command, send it to the KCD process
MSG_BUF *message;
g_is_reading = 0;
strcpy("\n\r", (char *)(g_in_buffer + g_in_index));
if (is_memory_available()) {
message = k_request_memory_block();
message->mtype = DEFAULT;
strcpy((char *)g_in_buffer, message->mtext);
k_send_message(PID_KCD, message);
}
g_in_index = 0;
}
break;
case '%':
if (!g_is_reading) {
// Start reading a command
g_is_reading = 1;
g_in_index = 1;
g_in_buffer[0] = '%';
break;
}
#if defined(DEBUG_0) && defined(_DEBUG_HOTKEYS)
case READY_Q_COMMAND:
if (!g_is_reading) {
print_ready();
break;
}
case MEMORY_Q_COMMAND:
if (!g_is_reading) {
print_mem_blocked();
break;
}
case RECEIVE_Q_COMMAND:
if (!g_is_reading) {
print_receive_blocked();
break;
}
case MESSAGE_COMMAND:
if (!g_is_reading) {
print_messages();
break;
}
#endif /* DEBUG HOTKEYS */
default:
if (g_is_reading) {
// TODO: check bounds
g_in_buffer[g_in_index++] = g_char_in;
}
}
gp_current_process = old_proc;
} else if (IIR_IntId & IIR_THRE) {
/* THRE Interrupt, transmit holding register becomes empty */
// Check for messages and load the buffer
// Perform a 'context switch' to the i-process
MSG_BUF *message;
PCB *old_proc = gp_current_process;
gp_current_process = k_get_process(PID_UART_IPROC);
// Don't block waiting for a message
while (is_message(PID_UART_IPROC)) {
int sender = PID_CRT;
char *c;
// Receive message and copy it to the buffer
message = k_receive_message(&sender);
c = message->mtext;
//dprintf("Copying message to buffer: %s\n\r", message->mtext);
if (*c != '\0') {
do {
g_out_buffer[g_out_end] = *c;
g_out_end = (g_out_end + 1) % OUTPUT_BUFF_SIZE;
c++;
} while (g_out_end != g_out_start && *c != '\0');
}
k_release_memory_block(message);
}
// Check if there is something in the circular buffer
if (g_out_start != g_out_end) {
g_char_out = g_out_buffer[g_out_start];
pUart->THR = g_char_out;
g_out_start = (g_out_start + 1) % OUTPUT_BUFF_SIZE;
} else {
// nothing to print, disable the THRE interrupt
pUart->IER ^= IER_THRE; // toggle (disable) the IER_THRE bit
}
gp_current_process = old_proc;
} else { /* not implemented yet */
#ifdef DEBUG_0
//uart1_put_string("Should not get here!\n\r");
#endif // DEBUG_0
__enable_irq();
return;
}
__enable_irq();
}
static void
on_sensor_value_notify(IsSensor *sensor,
GParamSpec *pspec,
gpointer user_data)
{
IsDynamicPlugin *self;
IsDynamicPluginPrivate *priv;
RateData *data;
gdouble value, dv, dt, rate;
gint64 now;
self = IS_DYNAMIC_PLUGIN(user_data);
priv = self->priv;
value = is_sensor_get_value(sensor);
if (value - IS_SENSOR_VALUE_UNSET <= DBL_EPSILON)
{
is_debug("dynamic", "sensor value for sensor %s is unset - ignoring",
is_sensor_get_label(sensor));
goto exit;
}
now = g_get_monotonic_time();
data = g_object_get_data(G_OBJECT(sensor), DYNAMIC_RATE_DATA_KEY);
if (data == NULL)
{
is_debug("dynamic", "Creating new dynamic rate data for sensor: %s",
is_sensor_get_label(sensor));
// allocate data
data = g_malloc0(sizeof(*data));
data->rate = 0.0f;
data->last_value = value;
data->last_time = now;
g_object_set_data_full(G_OBJECT(sensor), DYNAMIC_RATE_DATA_KEY,
data, g_free);
goto exit;
}
is_debug("dynamic", "Got existing rate data for sensor: %s - rate: %f, last_value %f, last_time %"PRId64"",
is_sensor_get_label(sensor),
data->rate,
data->last_value,
data->last_time);
dv = value - data->last_value;
dt = ((double)(now - data->last_time) /
(double)G_USEC_PER_SEC);
// convert rate to units per second
rate = fabs(dv / dt);
is_debug("dynamic", "abs rate of change of sensor %s: %f (t0: %f, t-1: %f, dv: %f, dt: %f)",
is_sensor_get_label(sensor), rate, value, data->last_value,
dv, dt);
// calculate exponentially weighted moving average of rate
rate = (EWMA_ALPHA * rate) + ((1 - EWMA_ALPHA) * data->rate);
data->rate = rate;
data->last_value = value;
data->last_time = now;
is_debug("dynamic", "EWMA abs rate of change of sensor %s: %f",
is_sensor_get_label(sensor), rate);
if (rate > priv->max_rate && sensor != priv->max)
{
// let's see if we can get away without taking a reference on sensor
priv->max = sensor;
is_message("dynamic", "New highest EWMA rate sensor: %s (rate %f)",
is_sensor_get_label(sensor), rate);
}
if (sensor == priv->max)
{
priv->max_rate = rate;
update_sensor_from_max(self);
}
exit:
return;
}
