a->init = init; // Set init function
a->sanity = sanity;
-
+ a->cleanup = cleanup;
pthread_mutex_init(&(a->mutex), NULL);
if (init != NULL)
/**
- * One off initialisation of *all* Actuators
+ * Initialisation of *all* Actuators
*/
-#include "actuators/ledtest.h"
-#include "actuators/filetest.h"
+#include "actuators/pregulator.h"
+#include "actuators/relays.h"
void Actuator_Init()
{
//Actuator_Add("ledtest",0, Ledtest_Set, NULL,NULL,NULL);
- Actuator_Add("filetest", 0, Filetest_Set, Filetest_Init, Filetest_Cleanup, Filetest_Sanity, 0);
+ //Actuator_Add("filetest", 0, Filetest_Set, Filetest_Init, Filetest_Cleanup, Filetest_Sanity, 0);
+ Actuator_Add("pregulator", 0, Pregulator_Set, Pregulator_Init, Pregulator_Cleanup, Pregulator_Sanity, 0);
+ Actuator_Add("can_select", RELAY_CANSELECT, Relay_Set, Relay_Init, Relay_Cleanup, Relay_Sanity, 0);
+ Actuator_Add("can_enable", RELAY_CANENABLE, Relay_Set, Relay_Init, Relay_Cleanup, Relay_Sanity, 0);
+ Actuator_Add("main_pressure", RELAY_MAIN, Relay_Set, Relay_Init, Relay_Cleanup, Relay_Sanity, 1);
+}
+
+/**
+ * Deinitialise actuators
+ */
+void Actuator_Cleanup()
+{
+ for (int i = 0; i < g_num_actuators; ++i)
+ {
+ Actuator * a = g_actuators+i;
+ if (a->cleanup != NULL)
+ a->cleanup(a->user_id);
+ }
+ g_num_actuators = 0;
}
+
/**
* Sets the actuator to the desired mode. No checks are
* done to see if setting to the desired mode will conflict with
*/
void Actuator_SetModeAll(ControlModes mode, void * arg)
{
+ if (mode == CONTROL_START)
+ Actuator_Init();
for (int i = 0; i < g_num_actuators; i++)
Actuator_SetMode(&g_actuators[i], mode, arg);
+ if (mode == CONTROL_STOP)
+ Actuator_Cleanup();
}
/**
// Currently does discrete steps after specified time intervals
struct timespec wait;
- DOUBLE_TO_TIMEVAL(a->control.stepsize, &wait);
+ DOUBLE_TO_TIMEVAL(a->control.stepwait, &wait);
while (!a->control_changed && a->control.steps > 0 && a->activated)
{
clock_nanosleep(CLOCK_MONOTONIC, 0, &wait, NULL);
ActuatorControl c = {0.0, 0.0, 0.0, 0}; // Need to set default values (since we don't require them all)
// sscanf returns the number of fields successfully read...
- int n = sscanf(set, "%lf,%lf,%lf,%d", &(c.start), &(c.stepwait), &(c.stepsize), &(c.steps)); // Set provided values in order
+ int n = sscanf(set, "%lf_%lf_%lf_%d", &(c.start), &(c.stepwait), &(c.stepsize), &(c.steps)); // Set provided values in order
if (n != 4)
{
// If the user doesn't provide all 4 values, the Actuator will get set *once* using the first of the provided values
/** Sanity check function **/
SanityFn sanity;
/** Cleanup function **/
- CleanFn clean;
+ CleanFn cleanup;
/** Last setting **/
DataPoint last_setting;
} Actuator;
extern void Actuator_Init(); // One off initialisation of *all* Actuators
+extern void Actuator_Cleanup();
extern void Actuator_SetModeAll(ControlModes mode, void *arg);
extern void Actuator_SetMode(Actuator * a, ControlModes mode, void *arg);
FLAGS = -std=c99 -Wall -pedantic -g -I../
#-I/usr/include/opencv -I/usr/include/opencv2/highgui For OpenCV
LIB = -lpthread
-OBJ = ledtest.o filetest.o
+OBJ = relays.o pregulator.o
HEADERS = $(wildcard *.h)
RM = rm -f
--- /dev/null
+#include "pregulator.h"
+#include "../bbb_pin.h"
+
+#define PREGULATOR_PWM ECAP0
+#define PREGULATOR_PERIOD 500000
+//16666667
+
+/**
+ * Initiliase the pressure regulator
+ */
+bool Pregulator_Init(const char * name, int id)
+{
+ return PWM_Export(PREGULATOR_PWM) && PWM_Set(PREGULATOR_PWM, false, PREGULATOR_PERIOD, 0);
+}
+
+bool Pregulator_Cleanup(int id)
+{
+ if (!PWM_Set(PREGULATOR_PWM, false, PREGULATOR_PERIOD, 0))
+ return false;
+ PWM_Unexport(PREGULATOR_PWM);
+ return true;
+}
+
+bool Pregulator_Set(int id, double value)
+{
+ return PWM_Set(PREGULATOR_PWM, false, PREGULATOR_PERIOD, value*(PREGULATOR_PERIOD));
+}
+
+bool Pregulator_Sanity(int id, double value)
+{
+ return (value >= 0.0 && value <= 1.0);
+}
+
--- /dev/null
+#ifndef _PREGULATOR
+
+#include "../common.h"
+
+extern bool Pregulator_Init(const char * name, int id);
+extern bool Pregulator_Cleanup(int id);
+extern bool Pregulator_Set(int id, double value);
+extern bool Pregulator_Sanity(int id, double value);
+
+
+#endif //_PREGULATOR
--- /dev/null
+#include "relays.h"
+#include "../log.h"
+
+#include "../bbb_pin.h"
+
+
+static int GetGPIO(int id)
+{
+ switch (id)
+ {
+ case RELAY_CANSELECT:
+ return 14;
+ case RELAY_CANENABLE:
+ return 115;
+ case RELAY_MAIN:
+ return 112;
+ }
+ Fatal("Unknown id %d", id);
+ return 0;
+}
+
+bool Relay_Init(const char * name, int id)
+{
+ if (!GPIO_Export(GetGPIO(id)))
+ return false;
+ return GPIO_Set(GetGPIO(id), false);
+}
+
+bool Relay_Cleanup(int id)
+{
+ bool err = GPIO_Set(GetGPIO(id), false);
+ GPIO_Unexport(GetGPIO(id));
+ return err;
+}
+
+bool Relay_Set(int id, double value)
+{
+ bool set = (bool)value;
+ return GPIO_Set(GetGPIO(id), set);
+}
+
+bool Relay_Sanity(int id, double value)
+{
+ //bool set = (bool)value;
+ //TODO: Make a more sane sanity check
+ return true;
+
+}
--- /dev/null
+#ifndef _RELAY_H
+#define _RELAY_H
+
+#include "../common.h"
+
+typedef enum
+{
+ RELAY_CANSELECT,
+ RELAY_CANENABLE,
+ RELAY_MAIN
+} RelayID;
+
+extern bool Relay_Init(const char * name, int id);
+extern bool Relay_Set(int id, double value);
+extern bool Relay_Sanity(int id, double value);
+extern bool Relay_Cleanup(int id);
+
+#endif //_RELAY_H
if (pread(g_adc[id].fd_value, adc_str, ADC_DIGITS-1, 0) == -1)
{
- AbortBool("ADC %d read failed: %s", id, strerror(errno));
+ //AbortBool("ADC %d read failed: %s", id, strerror(errno));
+ return false;
}
*value = strtol(adc_str, NULL, 10);
if (i > 0) {
FCGI_JSONValue(",\n\t\t");
}
- FCGI_JSONValue("\"%d\" : \"%s\"", i, Sensor_GetName(i));
+ DataPoint d = Sensor_LastData(i);
+ FCGI_JSONValue("\"%d\" : {\"name\" : \"%s\", \"value\" : [%f,%f] }",
+ i, Sensor_GetName(i), d.time_stamp, d.value);
}
FCGI_JSONValue("\n\t}");
}
if (i > 0) {
FCGI_JSONValue(",\n\t\t");
}
- FCGI_JSONValue("\"%d\" : \"%s\"", i, Actuator_GetName(i));
+
+ DataPoint d = Sensor_LastData(i);
+ FCGI_JSONValue("\"%d\" : {\"name\" : \"%s\", \"value\" : [%f, %f] }", i, Actuator_GetName(i), d.time_stamp, d.value);
}
FCGI_JSONValue("\n\t}");
}
{ //:(
Log(LOGWARN, "Locking control (no auth!)");
FCGI_LockControl(&context, NOAUTH_USERNAME, USER_ADMIN);
+ FCGI_SendControlCookie(&context, true);
}
else
{
{
Log(LOGDEBUG, "Begin cleanup.");
Sensor_Cleanup();
- //Actuator_Cleanup();
+ Actuator_Cleanup();
Log(LOGDEBUG, "Finish cleanup.");
}
- Sensor_Init();
- Actuator_Init();
Pin_Init();
// Try and start things
#auth_uri="ldap://192.168.1.1"
#auth_uri="ldaps://ldap.pheme.uwa.edu.au" #UWA
#auth_uri="/etc/shadow"
-auth_uri="shadow"
+#auth_uri="shadow"
# Set to the dn of the LDAP server
ldap_base_dn="ou=People,dc=daedalus" # Testing
## OPTIONS TO BE PASSED TO SERVER; DO NOT EDIT
-parameters="-v $verbosity -p $pin_test -A $auth_uri -d $ldap_base_dn"
+parameters="-v $verbosity -p $pin_test"
+# -A $auth_uri -d $ldap_base_dn"
s->init = init; // Set init function
// Start by averaging values taken over a second
- DOUBLE_TO_TIMEVAL(1e-4, &(s->sample_time));
+ DOUBLE_TO_TIMEVAL(1e-3, &(s->sample_time));
s->averages = 1;
s->num_read = 0;
s->current_data.time_stamp = 0;
s->current_data.value = 0;
+ s->averaged_data.time_stamp = 0;
+ s->averaged_data.value = 0;
return g_num_sensors;
}
#include "sensors/pressure.h"
void Sensor_Init()
{
- Sensor_Add("cpu_stime", RESOURCE_CPU_SYS, Resource_Read, NULL, NULL, NULL);
- Sensor_Add("cpu_utime", RESOURCE_CPU_USER, Resource_Read, NULL, NULL, NULL);
- //Sensor_Add("pressure_high0", PRES_HIGH0, Pressure_Read, Pressure_Init, Pressure_Cleanup, NULL);
- //Sensor_Add("pressure_high1", PRES_HIGH1, Pressure_Read, Pressure_Init, Pressure_Cleanup, NULL);
- //Sensor_Add("pressure_low0", PRES_LOW0, Pressure_Read, Pressure_Init, Pressure_Cleanup, NULL);
+ //Sensor_Add("cpu_stime", RESOURCE_CPU_SYS, Resource_Read, NULL, NULL, NULL);
+ //Sensor_Add("cpu_utime", RESOURCE_CPU_USER, Resource_Read, NULL, NULL, NULL);
+ Sensor_Add("pressure_high0", PRES_HIGH0, Pressure_Read, Pressure_Init, Pressure_Cleanup, NULL);
+ Sensor_Add("pressure_high1", PRES_HIGH1, Pressure_Read, Pressure_Init, Pressure_Cleanup, NULL);
+ Sensor_Add("pressure_low0", PRES_LOW0, Pressure_Read, Pressure_Init, Pressure_Cleanup, NULL);
//Sensor_Add("../testing/count.py", 0, Piped_Read, Piped_Init, Piped_Cleanup, 1e50,-1e50,1e50,-1e50);
- //Sensor_Add("strain0", STRAIN0, Strain_Read, Strain_Init, 5000,0,5000,0);
- //Sensor_Add("strain1", STRAIN1, Strain_Read, Strain_Init, 5000,0,5000,0);
- //Sensor_Add("strain2", STRAIN2, Strain_Read, Strain_Init, 5000,0,5000,0);
- //Sensor_Add("strain3", STRAIN3, Strain_Read, Strain_Init, 5000,0,5000,0);
+ Sensor_Add("strain0", STRAIN0, Strain_Read, Strain_Init, Strain_Cleanup, Strain_Sanity);
+ Sensor_Add("strain1", STRAIN1, Strain_Read, Strain_Init, Strain_Cleanup, Strain_Sanity);
+ Sensor_Add("strain2", STRAIN2, Strain_Read, Strain_Init, Strain_Cleanup, Strain_Sanity);
+ Sensor_Add("strain3", STRAIN3, Strain_Read, Strain_Init, Strain_Cleanup, Strain_Sanity);
//Sensor_Add("pressure0", PRESSURE0, Pressure_Read, Pressure_Init, 5000,0,5000,0);
//Sensor_Add("pressure1", PRESSURE1, Pressure_Read, Pressure_Init, 5000,0,5000,0);
//Sensor_Add("pressure_feedback", PRESSURE_FEEDBACK, Pressure_Read, Pressure_Init, 5000,0,5000,0);
if (s->cleanup != NULL)
s->cleanup(s->user_id);
}
+ g_num_sensors = 0;
}
/**
*/
void Sensor_SetModeAll(ControlModes mode, void * arg)
{
+ if (mode == CONTROL_START)
+ Sensor_Init();
for (int i = 0; i < g_num_sensors; i++)
Sensor_SetMode(&g_sensors[i], mode, arg);
+ if (mode == CONTROL_STOP)
+ Sensor_Cleanup();
}
// Until the sensor is stopped, record data points
while (s->activated)
{
- DataPoint d;
- d.value = 0;
- bool success = s->read(s->user_id, &(d.value));
+
+ bool success = s->read(s->user_id, &(s->current_data.value));
struct timespec t;
clock_gettime(CLOCK_MONOTONIC, &t);
- d.time_stamp = TIMEVAL_DIFF(t, *Control_GetStartTime());
+ s->current_data.time_stamp = TIMEVAL_DIFF(t, *Control_GetStartTime());
if (success)
{
if (s->sanity != NULL)
{
- if (!s->sanity(s->user_id, d.value))
+ if (!s->sanity(s->user_id, s->current_data.value))
{
Fatal("Sensor %s (%d,%d) reads unsafe value", s->name, s->id, s->user_id);
}
}
- s->current_data.time_stamp += d.time_stamp;
- s->current_data.value += d.value;
+ s->averaged_data.time_stamp += s->current_data.time_stamp;
+ s->averaged_data.value = s->current_data.value;
if (++(s->num_read) >= s->averages)
{
- s->current_data.time_stamp /= s->averages;
- s->current_data.value /= s->averages;
- Data_Save(&(s->data_file), &(s->current_data), 1); // Record it
+ s->averaged_data.time_stamp /= s->averages;
+ s->averaged_data.value /= s->averages;
+ Data_Save(&(s->data_file), &(s->averaged_data), 1); // Record it
s->num_read = 0;
- s->current_data.time_stamp = 0;
- s->current_data.value = 0;
+ s->averaged_data.time_stamp = 0;
+ s->averaged_data.value = 0;
}
}
else
- Log(LOGWARN, "Failed to read sensor %s (%d,%d)", s->name, s->id,s->user_id);
+ {
+ // Silence because strain sensors fail ~50% of the time :S
+ //Log(LOGWARN, "Failed to read sensor %s (%d,%d)", s->name, s->id,s->user_id);
+ }
clock_nanosleep(CLOCK_MONOTONIC, 0, &(s->sample_time), NULL);
return g_sensors[id].name;
}
+DataPoint Sensor_LastData(int id)
+{
+ Sensor * s = &(g_sensors[id]);
+ return s->current_data;
+}
int averages;
/** Current data **/
DataPoint current_data;
+
+ /** Summed data **/
+ DataPoint averaged_data;
/** Number of points read so far before applying average **/
int num_read;
extern void Sensor_Handler(FCGIContext *context, char * params); // Handle a FCGI request for Sensor data
+extern DataPoint Sensor_LastData(int id);
+
extern const char * Sensor_GetName(int id);
{
//double voltage = ADC_TO_VOLTS(adc); // convert reading to voltage
+ return (double)adc;
+
+ //TODO: Fix this
switch (id)
{
case PRES_HIGH0:
#include <pthread.h>
#define STRAIN_ADC ADC0
+// TODO: Choose this
+#define STRAIN_GPIO 15
/**
* Convert Strain gauge id number to a GPIO pin on the Mux
if (!GPIO_Set(gpio_num, false))
Fatal("Couldn't set GPIO%d for strain sensor %d to LOW", gpio_num, id);
- static bool init_adc = false;
- if (!init_adc)
+ static int init = 0;
+ if (++init == 1)
{
- init_adc = true;
+ GPIO_Export(STRAIN_GPIO);
+ GPIO_Set(STRAIN_GPIO, true);
ADC_Export(STRAIN_ADC);
}
return true;
}
+bool Strain_Cleanup(int id)
+{
+ static int killed = 0;
+ if (++killed == 4)
+ {
+
+ GPIO_Set(STRAIN_GPIO, false);
+ ADC_Unexport(STRAIN_ADC);
+ }
+
+ int gpio_num = Strain_To_GPIO(id);
+ GPIO_Unexport(gpio_num);
+ return true;
+}
+
+bool Strain_Sanity(int id, double value)
+{
+ return true;
+}
+
/**
* Read from a Strain gauge
* @param id - The strain gauge to read
// Read from a strain gauge
extern bool Strain_Read(int id, double * value);
+extern bool Strain_Cleanup(int id);
+extern bool Strain_Sanity(int id, double value);
+
#endif //_STRAIN_H
$(document).ready(function () {
$("form").submit(function () { //Prevent form submit globally
return false;
- })
+ });
//Set the status updated
$("#state-exp").setStatusUpdater();
//Set the logic for the start controls
- $("#start-controls").submit(function () {
+ $("#start-controls input[type='button']").click(function () {
var start = $("#start-controls input[type='button']");
var force = $("#start-controls input[name='start_force']");
$(this).setPressure(pressure, $("#pressure-result"));
});
- //Set logic for sensor sample rate thing
- $("#sensor-select").loadSensorList($("#samplerate-result"));
+ $("#pressure-controls input[name='clear']").click(function () {
+ $("#pressure-set")[0].reset();
+ });
+
+ $("#pressure-controls input[name='zero']").click(function () {
+ $("#pressure-controls input[name='clear']").click();
+ $("#pressure-set").val("0");
+
+ $("#pressure-controls").submit();
+ });
+
+ $("#pressure-controls input[name='step-it']").click(function () {
+ var pressure = {
+ set : $("#pressure-set").val(), step : "", wait : "", count : ""
+ };
+
+ $(this).setPressure(pressure, $("#pressure-result")).done(function () {
+ var next = Number($("#pressure-set").val()) + Number($("#pressure-stepsize").val());
+ $("#pressure-set").val(next.toString());
+ });
+
+ });
$("#samplerate-controls").submit(function () {
setSampleRate($("#sensor-select option:selected").val(),
$("#sensor-set").val(), $("#samplerate-result"));
</p>
<p class="centre">
- <input type="submit" name="start_strain" value="Strain test">
- <input type="submit" name="start_explode" value="Explode test">
+
+ <input type="button" name="start_explode" value="Explode test">
+ <input type="button" name="start_strain" value="Strain test">
</p>
</form>
</div>
</p>
<p class="right">
+ <input type="button" name="clear" value="Clear input">
+ <input type="button" name="zero" value="Zero the pressure">
+ <input type="button" name="step-it" value="Step the pressure">
<input type="submit" value="Set pressure">
</p>
</form>
$.fn.loadSensorList = function (result, input) {
var select = this;
+ select.empty(); //Reset list
$.ajax({
url : mctx.api + 'identify',
return;
}
for (var id in data.sensors) {
- var option = $("<option/>", {value : id, text : data.sensors[id]});
+ var option = $("<option/>", {value : id, text : data.sensors[id].name});
select.append(option);
}
});
fail = true;
}
- if (data.control_state_id !== mctx.control.state) {
+ if (data.control_state_id !== mctx.control.state) {
+ //Set logic for sensor sample rate thing
+ $("#sensor-select").loadSensorList($("#samplerate-result"));
toggleControls(running);
$(result).text(text);
if (fail) {
- $(result).parent().addClass("fail");
+ $(result).parent().addClass("fail").removeClass("pass");
} else {
- $(result).parent().addClass("pass");
+ $(result).parent().addClass("pass").removeClass("fail");
}
mctx.control.state = data.control_state_id;
$.fn.startExperiment = function (group, experiment, force, result) {
$(group).attr('disabled', 'disabled');
+ var can_number = ($(this).attr("name") === "start_strain") ? 0 : 1;
+
if (!experiment || !experiment.match(/^[a-zA-Z0-9_-]+$/)) {
result.text("Experiment names must be composed of alphanumeric characters" +
" or the characters -_-").addClass("fail");
data.force = 1;
}
+ //Start the experiment
$.ajax({
url : mctx.control.api,
data : data
if (!result.checkStatus(data)) {
return;
}
- result.html(" ");
- toggleControls(true);
- }).always(function () {
+
+ //Select the can
+ $.ajax({
+ url : mctx.api + "actuators",
+ data : {name : "can_select", set : can_number}
+ }).done(function (data) {
+ if (!result.checkStatus(data)) {
+ return;
+ }
+
+ //Enable the can
+ $.ajax({
+ url : mctx.api + 'actuators',
+ data : {name : "can_enable", set : 1}
+ }).done(function (data) {
+ if (!result.checkStatus(data)) {
+ return;
+ }
+ result.html(" ");
+ toggleControls(true);
+ }).always(function () {
+ $(group).removeAttr('disabled');
+ });
+ }).fail(function () {
+ $(group).removeAttr('disabled');
+ });
+ }).fail(function () {
$(group).removeAttr('disabled');
});
};
pressure[k] = n;
}
- var set = pressure['set'] + "," + pressure['wait'] + ","
- pressure['size'] + "," + pressure['count'];
- $.ajax({
+ var set = pressure['set'] + "_" + pressure['wait'] + "_" +
+ pressure['step'] + "_" + pressure['count'];
+ return $.ajax({
url : mctx.api + "actuators",
- data : {id : mctx.actuator.pressure_regulator, set : set}
+ data : {name : "pregulator", set : set}
}).done(function (data) {
if (!result.checkStatus(data)) {
return;
var apply = function(dict, prefix) {
$.each(dict, function(key, val) {
var attributes = {
- 'type' : input_type, 'value' : key, 'alt' : val,
+ 'type' : input_type, 'value' : key, 'alt' : val.name,
'class' : prefix, 'name' : group,
- 'id' : prefix + '_' + val //Unique id (name mangling)
+ 'id' : prefix + '_' + val.name //Unique id (name mangling)
};
var entry = $("<input/>", attributes);
- var label = $("<label/>", {'for' : prefix + '_' + val, 'text' : val});
+ var label = $("<label/>", {'for' : prefix + '_' + val.name, 'text' : val.name});
entry.prop("checked", check_first);
check_first = false;
container.append(entry).append(label);
--- /dev/null
+<head>
+<meta http-equiv="refresh" content="0">
+</head>
+
+<IMG SRC="/api/image">