Skip to content

E
elphel-apps-autocampars
Commit c6bb1fee authored by Andrey Filippov's avatar Andrey Filippov
Browse files
Options

more for eyesis, using curl_multi in PHP

parent 0fc43003
Show whitespace changes
Inline Side-by-side
Showing with 861 additions and 433 deletions
src/autocampars.php
View file @ c6bb1fee
...@@ -189,9 +189,12 @@ date_default_timezone_set('UTC'); ...@@ -189,9 +189,12 @@ date_default_timezone_set('UTC');
$GLOBALS['VERSION'] = '___VERSION___'; $GLOBALS['VERSION'] = '___VERSION___';
$GLOBALS['SRCREV'] = '___SRCREV___'; $GLOBALS['SRCREV'] = '___SRCREV___';
$GLOBALS['LOG_MAX_ECHO'] = 100; //longest log message to be output to screen, not only logged $GLOBALS['LOG_MAX_ECHO'] = 100; //longest log message to be output to screen, not only logged
$GLOBALS['BOOT_RETRIES'] = 10; //How many times to read status from two slaves until giving up
$GLOBALS['STOP_AFTER']=array( $GLOBALS['STOP_AFTER']=array(
'REBOOT' => true, // this state causes reboot of this camera, or if it is a master - all slaves too
'BOOT' => true, 'BOOT' => true,
'POWERED' => true, 'POWERED' => true,
'PRE10359' => true,
'BITSTREAM'=> true, 'BITSTREAM'=> true,
'SENSORS_DETECTED'=> true, 'SENSORS_DETECTED'=> true,
'SENSORS_SYNCHRONIZED'=>true, 'SENSORS_SYNCHRONIZED'=>true,
...@@ -209,7 +212,7 @@ $GLOBALS['twoColumns'] = false; ...@@ -209,7 +212,7 @@ $GLOBALS['twoColumns'] = false;
$logFilePath = "/var/log/autocampars.log"; $logFilePath = "/var/log/autocampars.log";
$GLOBALS['sysfs_detect_sensors'] = '/sys/devices/soc0/elphel393-detect_sensors@0'; // /sensor00 $GLOBALS['sysfs_detect_sensors'] = '/sys/devices/soc0/elphel393-detect_sensors@0'; // /sensor00
$GLOBALS['sysfs_frame_seq'] = '/sys/devices/soc0/elphel393-framepars@0/this_frame'; //[0..3] 0 (write <16 will reset the hardware sequencer) $GLOBALS['sysfs_frame_seq'] = '/sys/devices/soc0/elphel393-framepars@0/this_frame'; //[0..3] 0 (write <16 will reset the hardware sequencer)
$GLOBALS['sysfs_chn_en'] = '/sys/devices/soc0/elphel393-framepars@0/chn_en'; //channels enable (o blocks frame sync pulses) $GLOBALS['sysfs_chn_en'] = '/sys/devices/soc0/elphel393-framepars@0/chn_en'; //channels enable (to blocks frame sync pulses)
$GLOBALS['sysfs_i2c_seq'] = '/sys/devices/soc0/elphel393-sensor-i2c@0/i2c_frame'; $GLOBALS['sysfs_i2c_seq'] = '/sys/devices/soc0/elphel393-sensor-i2c@0/i2c_frame';
$GLOBALS ['sensor_port'] = -1; // not specified $GLOBALS ['sensor_port'] = -1; // not specified
$GLOBALS['master_port'] = -1; // Master port is the lowest number of existing ports $GLOBALS['master_port'] = -1; // Master port is the lowest number of existing ports
...@@ -252,16 +255,19 @@ $GLOBALS['framepars_paths'] = array ( ...@@ -252,16 +255,19 @@ $GLOBALS['framepars_paths'] = array (
"/dev/frameparsall3" "/dev/frameparsall3"
); );
$GLOBALS['configs'] = array(); $GLOBALS['configs'] = array();
// / $framepars_file=fopen("/dev/frameparsall","r"); $GLOBALS['init'] = false;
$GLOBALS['daemon'] = false;
log_open(); log_open();
get_application_mode(); // initializes state file (first time slow reading 10389 get_application_mode(); // initializes state file (first time slow reading 10389
//$GLOBALS['camera_state'] = $GLOBALS['camera_state_arr']['state'];
if (! in_array ( $GLOBALS['camera_state_arr']['state'], array_keys($GLOBALS['STOP_AFTER']) )) { if (! in_array ( $GLOBALS['camera_state_arr']['state'], array_keys($GLOBALS['STOP_AFTER']) )) {
log_error ( "Invalid camera state:" . $GLOBALS['camera_state_arr']['state'] . ", valid states are:\n" . print_r ( array_keys($GLOBALS['STOP_AFTER']), 1 )); respond_xml($GLOBALS['camera_state_arr']['state']," Invalid state, valid are: ". implode(',',array_keys($GLOBALS['STOP_AFTER']))); // will exit with error
} }
log_msg("Processing camera state: " . $GLOBALS['camera_state_arr']['state']); log_msg("Processing camera state: " . $GLOBALS['camera_state_arr']['state']);
get_sysfs_sensors(); get_sysfs_sensors();
...@@ -302,15 +308,15 @@ if (($_GET ['load'] != '') && ($GLOBALS['sensor_port'] >=0) && ($GLOBALS['camera ...@@ -302,15 +308,15 @@ if (($_GET ['load'] != '') && ($GLOBALS['sensor_port'] >=0) && ($GLOBALS['camera
} }
log_msg("groupMask=$groupMask"); log_msg("groupMask=$groupMask");
// var_dump($GLOBALS['configs'][$GLOBALS['sensor_port']] ['groupNames']); // var_dump($GLOBALS['configs'][$GLOBALS['sensor_port']] ['groupNames']);
$page = setParsFromPage ( $GLOBALS['sensor_port'], 0, $groupMask, false ); // /only init parameters? $page = setParsFromPage ( $GLOBALS['sensor_port'], 0, $groupMask); // /only init parameters?
log_close(); log_close();
exit ( 0 ); exit ( 0 );
} }
} }
$init = false; //$GLOBALS['init'] = false;
$daemon = false; //$GLOBALS['daemon'] = false;
$initPage = $GLOBALS['useDefaultPageNumber']; $initPage = $GLOBALS['useDefaultPageNumber'];
// For new - move current config (if any) out of the way // For new - move current config (if any) out of the way
...@@ -323,10 +329,10 @@ if ((array_key_exists ( 'new', $_GET )) || (in_array ( '--new', $_SERVER ['argv' ...@@ -323,10 +329,10 @@ if ((array_key_exists ( 'new', $_GET )) || (in_array ( '--new', $_SERVER ['argv'
} }
} }
} }
// TODO: move
foreach ( $_SERVER ['argv'] as $param ) { foreach ( $_SERVER ['argv'] as $param ) {
if (substr ( $param, 0, 6 ) == "--init") { if (substr ( $param, 0, 6 ) == "--init") {
$init = true; $GLOBALS['init'] = true;
} }
} }
...@@ -338,7 +344,7 @@ if (get_eyesis_mode()!=0){ // sets ($GLOBALS ['eyesis_mode'] ...@@ -338,7 +344,7 @@ if (get_eyesis_mode()!=0){ // sets ($GLOBALS ['eyesis_mode']
detect_eyesis(); detect_eyesis();
} else if (get_mt9p006_mode ()!=0){ // sets ($GLOBALS ['mt9p006_mode'] } else if (get_mt9p006_mode ()!=0){ // sets ($GLOBALS ['mt9p006_mode']
log_msg("+++ mt9p006"); log_msg("+++ mt9p006");
if ($init) { if ($GLOBALS['init']) {
reset_mt9p006(); // will only do smth. if stage is already higher that after sensor detection reset_mt9p006(); // will only do smth. if stage is already higher that after sensor detection
} }
detect_mt9p006(); detect_mt9p006();
...@@ -363,12 +369,12 @@ foreach ( $GLOBALS['ports'] as $port ) { ...@@ -363,12 +369,12 @@ foreach ( $GLOBALS['ports'] as $port ) {
} }
// //
log_msg(__LINE__.' $GLOBALS[init]='.$GLOBALS['init']);
if ($_SERVER ['REQUEST_METHOD'] == "GET") { if (($_SERVER ['REQUEST_METHOD'] == "GET") && ! ($GLOBALS['init'])) { // in init mode should go through init steps and return XML
processGet ($GLOBALS['sensor_port']); processGet ($GLOBALS['sensor_port']);
log_close(); log_close();
exit ( 0 ); exit ( 0 );
} else if ($_SERVER ['REQUEST_METHOD'] == "POST") { } else if (($_SERVER ['REQUEST_METHOD'] == "POST") && !($GLOBALS['init'])) { // in init mode should go through init steps and return XML
processPost ($GLOBALS['sensor_port']); processPost ($GLOBALS['sensor_port']);
processGet ($GLOBALS['sensor_port']); processGet ($GLOBALS['sensor_port']);
log_close(); log_close();
...@@ -380,30 +386,20 @@ if ($_SERVER ['REQUEST_METHOD'] == "GET") { ...@@ -380,30 +386,20 @@ if ($_SERVER ['REQUEST_METHOD'] == "GET") {
$old_versions[]=$GLOBALS['configs'][$port]['version']; $old_versions[]=$GLOBALS['configs'][$port]['version'];
} }
foreach ( $_SERVER ['argv'] as $param ) { foreach ( $_SERVER ['argv'] as $param ) {
if (substr ( $param, 0, 6 ) == "--init") { if (substr ( $param, 0, 8 ) == "--daemon") { // should have port?
/* no support for '--init=page' (can be different for ports) $GLOBALS['daemon'] = true;
$param = substr ( $param, 7 );
if (strlen ( $param ) > 0)
$initPage = myval ( $param );
if (($initPage < 0) || ($initPage > $GLOBALS['useDefaultPageNumber']))
$initPage = $GLOBALS['useDefaultPageNumber'];
*/
$init = true;
} else if (substr ( $param, 0, 8 ) == "--daemon") { // should have port?
$daemon = true;
} else if (substr ( $param, 0, 14 ) == "--sensor_port=") { // should have port? } else if (substr ( $param, 0, 14 ) == "--sensor_port=") { // should have port?
$GLOBALS['sensor_port']=intval(substr ( $param, 14, 1 )); $GLOBALS['sensor_port']=intval(substr ( $param, 14, 1 ));
} else if ($param == '--ignore-revision') { } else if ($param == '--ignore-revision') {
//get_port_index($port) //get_port_index($port)
foreach ( $GLOBALS['ports'] as $port ) { foreach ( $GLOBALS['ports'] as $port ) {
$GLOBALS['configs'][$port]['version'] = $GLOBALS['version']; $GLOBALS['configs'][$port]['version'] = $GLOBALS['version'];
log_msg("processPost($port) --ignore_revision"); log_msg(" --ignore_revision is set");
saveRotateConfig ($port, $GLOBALS['numBackups'] ); saveRotateConfig ($port, $GLOBALS['numBackups'] );
} }
} }
} }
if (! $daemon && ! $init) { if (! $GLOBALS['daemon'] && ! $GLOBALS['init']) {
$configs = print_r($GLOBALS ['configPaths'],1); $configs = print_r($GLOBALS ['configPaths'],1);
echo <<<USAGE echo <<<USAGE
...@@ -452,12 +448,11 @@ WARN; ...@@ -452,12 +448,11 @@ WARN;
echo $warn; echo $warn;
log_msg($warn); log_msg($warn);
if ($GLOBALS['version'] != $GLOBALS['configs'][$port]['version']){ if ($GLOBALS['version'] != $GLOBALS['configs'][$port]['version']){
log_close(); respond_xml('','Version mismatch'); // will exit
exit ( 1 ); // / abort
} }
} }
} }
if ($init) { if ($GLOBALS['init']) {
log_msg ( "GLOBALS['eyesis_mode']= >".$GLOBALS['eyesis_mode']."<"); log_msg ( "GLOBALS['eyesis_mode']= >".$GLOBALS['eyesis_mode']."<");
log_msg ( "GLOBALS['mt9p006_mode']= >".$GLOBALS['mt9p006_mode']."<"); log_msg ( "GLOBALS['mt9p006_mode']= >".$GLOBALS['mt9p006_mode']."<");
...@@ -472,25 +467,20 @@ if ($init) { ...@@ -472,25 +467,20 @@ if ($init) {
if ($GLOBALS['camera_state_arr']['state'] != 'INITIALIZED') { if ($GLOBALS['camera_state_arr']['state'] != 'INITIALIZED') {
log_msg ( "Camera failed to initialize, see $logFilePath for detailes" ); log_msg ( "Camera failed to initialize, see $logFilePath for detailes" );
log_msg ( "Camera state = ".$GLOBALS['camera_state_arr']['state'] ); log_msg ( "Camera state = ".$GLOBALS['camera_state_arr']['state'] );
log_close (); respond_xml($GLOBALS['camera_state_arr']['state']); // will exit no error
exit ( 1 );
} else { } else {
$port_list_string = implode ( ", ", $GLOBALS['ports'] ); $port_list_string = implode ( ", ", $GLOBALS['ports'] );
// $page_list_string = implode ( ", ", $page );
// log_msg ( "Sensors on ports: $port_list_string were successfully initialized from configuration files pages $page_list_string", 1 );
log_msg ( "Sensors on ports: $port_list_string were successfully initialized", 1 ); log_msg ( "Sensors on ports: $port_list_string were successfully initialized", 1 );
} }
if ($GLOBALS ['version'] != $GLOBALS ['configs'] [$port] ['version']) { if ($GLOBALS ['version'] != $GLOBALS ['configs'] [$port] ['version']) {
log_close (); respond_xml($GLOBALS['camera_state_arr']['state'],'revisions differ'); // will exit
exit ( 1 );
} }
log_close (); respond_xml($GLOBALS['camera_state_arr']['state']); // will exit no error
exit ( 0 );
} }
if ($daemon) { if ($GLOBALS['daemon']) {
processDaemon ( $GLOBALS ['sensor_port'] ); processDaemon ( $GLOBALS ['sensor_port'] );
log_close (); log_close ();
exit ( 0 ); exit ( 0 );
...@@ -519,7 +509,6 @@ function update_minor_version($port, $silent = 0) { ...@@ -519,7 +509,6 @@ function update_minor_version($port, $silent = 0) {
} }
} }
function get_port_index($port){ function get_port_index($port){
for ($i = 0; $i < count($GLOBALS['ports']); $i++) if ( $GLOBALS['ports'][$i] == $port ) return $i; for ($i = 0; $i < count($GLOBALS['ports']); $i++) if ( $GLOBALS['ports'][$i] == $port ) return $i;
return -1; return -1;
...@@ -527,6 +516,249 @@ function get_port_index($port){ ...@@ -527,6 +516,249 @@ function get_port_index($port){
function detect_eyesis(){ function detect_eyesis(){
log_msg("detect_eyesis()"); log_msg("detect_eyesis()");
$max_frame_time = 100000; // usec, should exceed longest initial free frame period
$GLOBALS['camera_state_arr']['max_frame_time'] = 100000; // usec, should exceed longest initial free frame period
$GLOBALS['camera_state_arr']['max_latency'] = 5; // frames to manually advance
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
$sensor_code = 52;
log_msg("detect_eyesis():\n".str_sensors($GLOBALS['sensors']),1);
// Not needed - set by get_sysfs_sensors()/ update_sysfs_sensors()
// $GLOBALS['ports'] = array(); // list of enabled ports
// for ($port=0; $port < 4; $port++) if ($GLOBALS['sensors'][$port][0] == 'mt9p006') $GLOBALS['ports'][] = $port;
log_msg("ports:". implode(", ",$GLOBALS['ports']));
switch ($GLOBALS['camera_state_arr']['state']){
case 'REBOOT':
log_msg("rebooting...");
case 'BOOT':
log_msg("boot");
// Apply sensor mask from the application mode, update sysfs
$sensor_mask = get_eyesis_mode (); // 20 bit - for each channel of each port and port multiplexers (typical Eyesis 0xf7777)
$needupdate=0;
for($port = 0; $port < 4; $port++){
for ($chn = 0; $chn < 4; $chn++){
if (($sensor_mask & 1)==0){
if ($GLOBALS['sensors'][$port][$chn] != 'none'){
$GLOBALS['sensors'][$port][$chn] = 'none';
$needupdate=1;
}
}
$sensor_mask = $sensor_mask >> 1;
}
}
if ($GLOBALS['port_mux']) { // only if defined
for($port = 0; $port < 4; $port++) {
if (($sensor_mask & 1)==0) {
if ($GLOBALS['port_mux'][$port] != 'none') {
$GLOBALS['port_mux'][$port] = 'none';
$needupdate = 1;
}
}
$sensor_mask = $sensor_mask >> 1;
}
}
if ($needupdate) update_sysfs_sensors();
// All eyesis cameras - disable fan control to re-use for 10359 power
$rslt=set_eyesis_power_control();
log_msg("set_eyesis_power_control()=>".print_r($rslt,1));
log_msg("GLOBALS['camera_state_arr']=>".print_r($GLOBALS['camera_state_arr'],1));
$GLOBALS['camera_state_arr'] = array_merge($GLOBALS['camera_state_arr'], eyesis_get_IPs());
if (is_eyesis_master()) $GLOBALS['camera_state_arr']['is_master'] = is_eyesis_master();
if (is_eyesis_slave()) $GLOBALS['camera_state_arr']['is_slave'] = is_eyesis_slave();
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
log_msg('Current state: '. $GLOBALS['camera_state_arr']['state']);
if ($GLOBALS['camera_state_arr']['state'] == 'REBOOT') {
reboot_all_if_master(); // will exit anyway (dso nothing if not master)
}
if ($GLOBALS['camera_state_arr']['is_slave']){
respond_xml('This is a slave camera - waiting for master to contol next steps',''); // will exit(0)
}
if (!$GLOBALS['camera_state_arr']['is_master']){
respond_xml('', 'This is a neither slave, no master camera - waiting for master to contol next steps - aborting'); // will exit(1)
}
log_msg("Continue with master camera");
log_msg("=== Setting FPGA and sensor power ===");
/*
// just testing error handling
$states= get_remote_states(array(
$GLOBALS['camera_state_arr']['ip_top'],
$GLOBALS['camera_state_arr']['ip_middle'],
$GLOBALS['camera_state_arr']['ip_bottom'],
"192.168.0.4",
"192.168.0.33"));
log_msg("remote states: ".print_r($states,1), 1);
*/
$rslt = wait_slaves_boot($GLOBALS['BOOT_RETRIES']);
if ($rslt !== true){
log_msg ('wait_slaves_boot() => '.print_r($rslt,1));
log_msg ('If both states are post BOOT - system reboot is required. TODO: Add master-initiated reboot of all cameras (probably by master --init');
break;
}
// TODO: convert to curl_multi?
eyesis_all_power_fpga('hargs-power_par12');
eyesis_all_power_fpga('hargs-power-eyesis');
eyesis_all_power_fpga('hargs-post-par12');
$ips_10359 = array(
$GLOBALS['camera_state_arr']['ip_top'],
$GLOBALS['camera_state_arr']['ip_middle']);
log_msg("Loading 10359 bitstreams");
// Try curl_multi instead
log_msg($cmd.'Trying curl_multi');
$urls=array();
foreach ($ips_10359 as $ip){
$urls[] = "http://".$ip."/autocampars.php?init_stage=PRE10359";
}
$curl_data = curl_multi_start($urls);
log_msg($cmd.'Started curl_multi');
// can not exit until joined
case 'PRE10359':
if ($GLOBALS['port_mux']) {
for($port = 0; $port < 4; $port++) {
if ($GLOBALS['port_mux'][$port] != 'none') {
unset ($output);
exec ('cat /usr/local/verilog/x359.bit > /dev/sfpgaconfjtag' . $port, $output, $retval);
log_msg ('cat /usr/local/verilog/x359.bit > /dev/sfpgaconfjtag' . $port . ' => ' . $retval);
}
}
}
$GLOBALS['camera_state_arr']['state'] ='BITSTREAM';
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
if (!isset ($curl_data)){ // do not break if waiting for slaves
if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break;
}
case 'BITSTREAM':
// ***** Sensor detection stage is the same for all sensors so far, can be combined Eyesis/non-Eyesis
$frame_nums=array(-1,-1,-1,-1);
// Open files for only enabled channels
foreach ($GLOBALS['ports'] as $port) {
$f = fopen ( $GLOBALS ['framepars_paths'] [$port], "w+");
fseek ( $f, ELPHEL_LSEEK_FRAMEPARS_INIT, SEEK_END );
// This is for 10359 - probably still OK for non-10359
elphel_set_P_value ( $port, ELPHEL_MULTI_CFG, 1); // cy22393 does not work on 10359. Not enough 3.3V?
// now it may be OK (with separate 10359 power)
elphel_set_P_value ( $port, ELPHEL_SENSOR, 0x00, 0, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC );// / will start detection
$frame_nums[$port]=elphel_get_frame($port);
fclose($f);
log_msg("Started detection for sensor port ".$port);
}
// detection process only removes, not adds channels. So device tree and 10389 should enable maximum possible
$needupdate=0;
foreach ($GLOBALS['ports'] as $port) {
if (elphel_get_P_value ( $port, ELPHEL_SENSOR) != $sensor_code){
log_msg("#### Wrong/missing sensor on port ".$port.", code=".elphel_get_P_value ( $port, ELPHEL_SENSOR).
' (expected '.$sensor_code.") . Driver reports errors until port is disabled at later stage ####",1);
for ($chn =0; $chn <4; $chn++) {
$GLOBALS['sensors'][$port][$chn] = 'none';
}
$needupdate=1;
} else {
$channel_mask = elphel_get_P_value ( $port, ELPHEL_SENS_AVAIL);
if (!$channel_mask) {
if ($GLOBALS['port_mux']){
if ($GLOBALS['port_mux'][$port] != 'none'){
$GLOBALS['port_mux'][$port] = 'none';
$needupdate = 1;
}
}
$channel_mask = 1;// no-mux sensor on
}
for ($chn =0; $chn <4; $chn++) {
if (($channel_mask & 1) == 0) {
if ($GLOBALS['sensors'][$port][$chn] != 'none') {
$GLOBALS['sensors'][$port][$chn] = 'none';
$needupdate=1;
}
}
$channel_mask = $channel_mask >> 1;
}
}
}
if ($needupdate) update_sysfs_sensors();
log_msg("detected sensors:\n".str_sensors($GLOBALS['sensors']),1);
// Collect results from slave channels that were running in parallel
$nrep =0;
if (isset ($curl_data)){ // wait and collect responses
$enable_echo = !array_key_exists('REQUEST_METHOD',$_SERVER);
if ($enable_echo) echo "Waiting slaves to finish: ";
$results = curl_multi_finish($curl_data, true, 0, $enable_echo);
log_msg('curl_multi returned: '.print_r($results,1));
}
$GLOBALS['camera_state_arr']['state'] ='SENSORS_DETECTED';
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
log_msg('Reached state: '. $GLOBALS['camera_state_arr']['state']);
// temporarily, later make optional:
respond_xml($GLOBALS['camera_state_arr']['state']); // will exit
exit(0); // just in case - if something will break
// if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break;
break;
case 'SENSORS_DETECTED':
// Program trigger modes (inactive), stop and reset command sequencers
foreach ($GLOBALS['ports'] as $port) {
if ($port==$GLOBALS['master_port']){
elphel_set_P_value ( $port, ELPHEL_TRIG_MASTER, $GLOBALS['master_port'], ELPHEL_CONST_FRAME_IMMED);
elphel_set_P_value ( $port, ELPHEL_TRIG_PERIOD, 0, ELPHEL_CONST_FRAME_IMMED);
elphel_set_P_value ( $port, ELPHEL_TRIG_BITLENGTH, 0, ELPHEL_CONST_FRAME_IMMED);
elphel_set_P_value ( $port, ELPHEL_EXTERN_TIMESTAMP, 1, ELPHEL_CONST_FRAME_IMMED);
elphel_set_P_value ( $port, ELPHEL_XMIT_TIMESTAMP, 1, ELPHEL_CONST_FRAME_IMMED);
elphel_set_P_value ( $port, ELPHEL_TRIG_OUT, 0x55555, ELPHEL_CONST_FRAME_IMMED);
elphel_set_P_value ( $port, ELPHEL_TRIG_CONDITION, 0x55555, ELPHEL_CONST_FRAME_IMMED);
}
elphel_set_P_value ( $port, ELPHEL_TRIG_DELAY, 0, ELPHEL_CONST_FRAME_IMMED);
}
usleep ($GLOBALS['camera_state_arr']['max_frame_time']); // > 1 frame, so all channels will get trigger parameters? //1 1 0 0 -> 3 2 2 1
foreach ($GLOBALS['ports'] as $port) {
elphel_set_P_value ( $port, ELPHEL_TRIG, ELPHEL_CONST_TRIGMODE_SNAPSHOT, ELPHEL_CONST_FRAME_IMMED);
}
// Single trigger 3 2 2 1-> 3 2 2 1
elphel_set_P_value ( $GLOBALS['master_port'], ELPHEL_TRIG_PERIOD, 1, ELPHEL_CONST_FRAME_IMMED, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC);
usleep ($GLOBALS['camera_state_arr']['max_frame_time']); // > 1 frame, so all channels will get trigger parameters? 3 2 2 1 -> 4 3 3 2
//Check that now all frame parameters are the same?
// reset sequencers
for ($port=0; $port < 4; $port++){
$f = fopen ( $GLOBALS['sysfs_frame_seq'].$port, 'w' ); fwrite($f,'0',1); fclose ( $f );
$f = fopen ( $GLOBALS['sysfs_i2c_seq'].$port, 'w' ); fwrite($f,'3',1); fclose ( $f ); // reset+run (copy frame number from frame_seq)
if (!in_array($port, $GLOBALS['ports'])) {
log_msg("Disabling sensor port ".$port);
$f = fopen ( $GLOBALS['sysfs_chn_en'].$port, 'w' ); fwrite($f,'0',1); fclose ( $f ); // disable sensor channel
}
}
// Single trigger
elphel_set_P_value ( $GLOBALS['master_port'], ELPHEL_TRIG_PERIOD, 1, ELPHEL_CONST_FRAME_IMMED, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC);
usleep ($GLOBALS['camera_state_arr']['max_frame_time']); // > 1 frame, so all channels will get trigger parameters? // 0 0 0 0 -> 1 1 1 1
//echo "9. frames:\n"; for ($ii=0;$ii<4;$ii++) $frame_nums[$ii]=elphel_get_frame($ii); print_r($frame_nums);
$GLOBALS['camera_state_arr']['state'] ='SENSORS_SYNCHRONIZED';
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
log_msg('Frames: '. implode(", ",$frame_nums));
log_msg('Reached state: '. $GLOBALS['camera_state_arr']['state']);
if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break; // will break anyway
default:
log_msg("camera_state=".$GLOBALS['camera_state_arr']['state']);
}
log_msg("ports:". implode(", ",$GLOBALS['ports']));
} }
function str_sensors($sens_arr){ function str_sensors($sens_arr){
...@@ -538,15 +770,15 @@ function str_sensors($sens_arr){ ...@@ -538,15 +770,15 @@ function str_sensors($sens_arr){
/** Prepare camera to be re-initialized if 'init' mode is set and stage is later than that*/ /** Prepare camera to be re-initialized if 'init' mode is set and stage is later than that*/
function reset_mt9p006(){ function reset_mt9p006(){
switch ($GLOBALS['camera_state_arr']['state']){ switch ($GLOBALS['camera_state_arr']['state']){
case "BOOT": case 'BOOT':
case "POWERED": case "POWERED":
case "BITSTREAM": case 'BITSTREAM':
// Keep these too? // Keep these too?
case "SENSORS_DETECTED": case 'SENSORS_DETECTED':
case "SENSORS_SYNCHRONIZED": case 'SENSORS_SYNCHRONIZED':
case "PARAMETERS_PRESET": case 'PARAMETERS_PRESET':
case "SEQUENCERS_ADVANCED": case 'SEQUENCERS_ADVANCED':
return; // do nothing just continue return; // do nothing just continue
default: // later stage, need resetting default: // later stage, need resetting
...@@ -599,33 +831,18 @@ function detect_mt9p006(){ ...@@ -599,33 +831,18 @@ function detect_mt9p006(){
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] ); write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
$sensor_code = 52; $sensor_code = 52;
log_msg("detect_mt9p006():\n".str_sensors($GLOBALS['sensors']),1); log_msg("detect_mt9p006():\n".str_sensors($GLOBALS['sensors']),1);
$GLOBALS['ports'] = array(); // list of enabled ports // Not needed - set by get_sysfs_sensors()/ update_sysfs_sensors()
for ($port=0; $port < 4; $port++) if ($GLOBALS['sensors'][$port][0] == 'mt9p006') $GLOBALS['ports'][] = $port; // $GLOBALS['ports'] = array(); // list of enabled ports
// for ($port=0; $port < 4; $port++) if ($GLOBALS['sensors'][$port][0] == 'mt9p006') $GLOBALS['ports'][] = $port;
log_msg("ports:". implode(", ",$GLOBALS['ports'])); log_msg("ports:". implode(", ",$GLOBALS['ports']));
switch ($GLOBALS['camera_state_arr']['state']){ switch ($GLOBALS['camera_state_arr']['state']){
/* case 'REBOOT':
case "BOOT": log_msg("rebooting...");
echo "boot\n"; reboot_all_if_master(); // will also generate xml if in http mode
unset ($output);
exec ( 'autocampars.py localhost py393 hargs-power_par12', $output, $retval );
$GLOBALS['camera_state_arr']['state'] ='POWERED';
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
log_msg("COMMAND_OUTPUT for 'autocampars.py localhost py393 hargs-power_par12':\n".
print_r($output,1)."\ncommand return value=".$retval."\n");
// No break here
case "POWERED":
unset ($output);
exec ( 'autocampars.py localhost py393 hargs-post-par12', $output, $retval );
log_msg("OMMAND_OUTPUT for autocampars.py localhost py393 hargs-post-par12':\n".
print_r($output,1)."\ncommand return value=".$retval."\n");
$GLOBALS['camera_state_arr']['state'] ='BITSTREAM';
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
log_msg('Reached state: '. $GLOBALS['camera_state_arr']['state']);
// break;
*/
// single command (power+post_power) // single command (power+post_power)
case "BOOT": case 'BOOT':
log_msg("boot"); log_msg("boot");
// correct sysfs sensor data // correct sysfs sensor data
$sensor_mask = get_mt9p006_mode (); $sensor_mask = get_mt9p006_mode ();
...@@ -643,13 +860,13 @@ function detect_mt9p006(){ ...@@ -643,13 +860,13 @@ function detect_mt9p006(){
log_msg("COMMAND_OUTPUT for 'autocampars.py localhost py393 hargs-power_par12':\n". log_msg("COMMAND_OUTPUT for 'autocampars.py localhost py393 hargs-power_par12':\n".
print_r($output,1)."\ncommand return value=".$retval."\n"); print_r($output,1)."\ncommand return value=".$retval."\n");
if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break; if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break;
case "BITSTREAM": case 'BITSTREAM':
$frame_nums=array(-1,-1,-1,-1); $frame_nums=array(-1,-1,-1,-1);
$GLOBALS['master_port'] =-1; /// $GLOBALS['master_port'] =-1;
// Open files for only enabled channels // Open files for only enabled channels
foreach ($GLOBALS['ports'] as $port) { foreach ($GLOBALS['ports'] as $port) {
$f = fopen ( $GLOBALS ['framepars_paths'] [$port], "w+"); $f = fopen ( $GLOBALS ['framepars_paths'] [$port], "w+");
if ($GLOBALS['master_port'] < 0) $GLOBALS['master_port'] = $port; /// if ($GLOBALS['master_port'] < 0) $GLOBALS['master_port'] = $port;
fseek ( $f, ELPHEL_LSEEK_FRAMEPARS_INIT, SEEK_END ); fseek ( $f, ELPHEL_LSEEK_FRAMEPARS_INIT, SEEK_END );
elphel_set_P_value ( $port, ELPHEL_SENSOR, 0x00, 0, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC ); elphel_set_P_value ( $port, ELPHEL_SENSOR, 0x00, 0, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC );
$frame_nums[$port]=elphel_get_frame($port); $frame_nums[$port]=elphel_get_frame($port);
...@@ -670,7 +887,7 @@ function detect_mt9p006(){ ...@@ -670,7 +887,7 @@ function detect_mt9p006(){
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] ); write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
log_msg('Reached state: '. $GLOBALS['camera_state_arr']['state']); log_msg('Reached state: '. $GLOBALS['camera_state_arr']['state']);
if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break; if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break;
case "SENSORS_DETECTED": case 'SENSORS_DETECTED':
// Program trigger modes (inactive), stop and reset command sequencers // Program trigger modes (inactive), stop and reset command sequencers
foreach ($GLOBALS['ports'] as $port) { foreach ($GLOBALS['ports'] as $port) {
if ($port==$GLOBALS['master_port']){ if ($port==$GLOBALS['master_port']){
...@@ -734,8 +951,8 @@ function init_mt9p006(){ // $page) { init can only be from default page as page ...@@ -734,8 +951,8 @@ function init_mt9p006(){ // $page) { init can only be from default page as page
} }
switch ($GLOBALS['camera_state_arr']['state']){ switch ($GLOBALS['camera_state_arr']['state']){
case "SENSORS_SYNCHRONIZED": case 'SENSORS_SYNCHRONIZED':
case "SEQUENCERS_ADVANCED": case 'SEQUENCERS_ADVANCED':
$port_page=array(); $port_page=array();
foreach ( $GLOBALS['ports'] as $port ) { foreach ( $GLOBALS['ports'] as $port ) {
$port_page[$port] = $GLOBALS ['configs'] [$port] ['defaultPage']; $port_page[$port] = $GLOBALS ['configs'] [$port] ['defaultPage'];
...@@ -744,7 +961,7 @@ function init_mt9p006(){ // $page) { init can only be from default page as page ...@@ -744,7 +961,7 @@ function init_mt9p006(){ // $page) { init can only be from default page as page
} }
switch ($GLOBALS['camera_state_arr']['state']){ switch ($GLOBALS['camera_state_arr']['state']){
case "SENSORS_SYNCHRONIZED": case 'SENSORS_SYNCHRONIZED':
// Set most parameters in immediate mode (to protect from i2c 64-command overflow), // Set most parameters in immediate mode (to protect from i2c 64-command overflow),
// then others through the sequencers while sesnor is stopped (waiting for manual triggers) // then others through the sequencers while sesnor is stopped (waiting for manual triggers)
$all_parToSet = filterParsKeepRemove($all_port_pars, $delayed_par_names, false ); // remove listed parameters $all_parToSet = filterParsKeepRemove($all_port_pars, $delayed_par_names, false ); // remove listed parameters
...@@ -819,7 +1036,7 @@ function init_mt9p006(){ // $page) { init can only be from default page as page ...@@ -819,7 +1036,7 @@ function init_mt9p006(){ // $page) { init can only be from default page as page
log_msg("will need to skip ".$GLOBALS['camera_state_arr']['frames_skip'].' frames'); log_msg("will need to skip ".$GLOBALS['camera_state_arr']['frames_skip'].' frames');
log_msg("reached state ".$GLOBALS['camera_state_arr']['state']); log_msg("reached state ".$GLOBALS['camera_state_arr']['state']);
if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break; if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break;
case "PARAMETERS_PRESET": case 'PARAMETERS_PRESET':
log_msg("Skipping ".$GLOBALS['camera_state_arr']['frames_skip']." frames"); log_msg("Skipping ".$GLOBALS['camera_state_arr']['frames_skip']." frames");
for ($i = 0; $i< $GLOBALS['camera_state_arr']['frames_skip']; $i++){ for ($i = 0; $i< $GLOBALS['camera_state_arr']['frames_skip']; $i++){
// Single trigger // Single trigger
...@@ -831,7 +1048,7 @@ function init_mt9p006(){ // $page) { init can only be from default page as page ...@@ -831,7 +1048,7 @@ function init_mt9p006(){ // $page) { init can only be from default page as page
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] ); write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
log_msg("reached state ".$GLOBALS['camera_state_arr']['state']); log_msg("reached state ".$GLOBALS['camera_state_arr']['state']);
if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break; if ($GLOBALS['STOP_AFTER'][$GLOBALS['camera_state_arr']['state']]) break;
case "SEQUENCERS_ADVANCED": // now set periodic trigger (if needed) in immediate mode - FPGA period will be overwritten case 'SEQUENCERS_ADVANCED': // now set periodic trigger (if needed) in immediate mode - FPGA period will be overwritten
// by single-pulse advances // by single-pulse advances
$port_page=array(); $port_page=array();
foreach ( $GLOBALS['ports'] as $port ) { foreach ( $GLOBALS['ports'] as $port ) {
...@@ -862,22 +1079,40 @@ function init_mt9p006(){ // $page) { init can only be from default page as page ...@@ -862,22 +1079,40 @@ function init_mt9p006(){ // $page) { init can only be from default page as page
function get_sysfs_sensors() function get_sysfs_sensors()
{ {
$GLOBALS['ports'] = array(); // list of enabled ports $GLOBALS['ports'] = array(); // list of enabled ports
$GLOBALS['sensors']=array('none','none','none','none'); $GLOBALS['sensors']= array('none','none','none','none');
$GLOBALS['port_mux']=array('none','none','none','none');
$use_mux=false;
for ($port = 0; $port < 4; $port++){ for ($port = 0; $port < 4; $port++){
$GLOBALS['sensors'][$port] = array('none','none','none','none'); $GLOBALS['sensors'][$port] = array('none','none','none','none');
for ($chn = 0; $chn < 4; $chn++){ for ($chn = 0; $chn < 4; $chn++){
$GLOBALS['sensors'][$port][$chn]=trim(file_get_contents( $GLOBALS['sysfs_detect_sensors'] . '/sensor' . $port . $chn)); $GLOBALS['sensors'][$port][$chn]=trim(file_get_contents( $GLOBALS['sysfs_detect_sensors'] . '/sensor' . $port . $chn));
} }
$GLOBALS['port_mux'][$port]=trim(file_get_contents( $GLOBALS['sysfs_detect_sensors'] . '/port_mux' . $port));
if ($GLOBALS['port_mux'][$port] != 'none') $use_mux=true;
} }
for ($port=0; $port < 4; $port++) if ($GLOBALS['sensors'][$port][0] != 'none') { if (!$use_mux){
unset($GLOBALS['port_mux']);
}
// Create list of active ports
for ($port=0; $port < 4; $port++) { // if at least one subchannel active - enable port
for ($chn = 0; $chn < 4; $chn++) if ($GLOBALS['sensors'][$port][$chn] != 'none') {
$GLOBALS['ports'][] = $port; $GLOBALS['ports'][] = $port;
break;
}
} }
// Master port is the lowest number of existing ports // Master port is the lowest number of existing ports
for ($port=0; $port < 4; $port++) if ($GLOBALS['sensors'][$port][0] != 'none') { if ($GLOBALS['ports']) $GLOBALS['master_port'] = $GLOBALS['ports'][0]; // first port
$GLOBALS['master_port'] = $port; else $GLOBALS['master_port'] = -1; // no sensor ports at all
break; log_msg ("Got sensor map from sysfs: ".str_sensors($GLOBALS['sensors']));
if ($GLOBALS['port_mux']){
log_msg ("Got port multiplexer map from sysfs: ".implode(',', $GLOBALS['port_mux']));
} }
log_msg ("Active sensor ports: ".implode(',', $GLOBALS['ports']).' master_port = '. $GLOBALS['master_port']);
// for ($port=0; $port < 4; $port++) if ($GLOBALS['sensors'][$port][0] != 'none') {
// $GLOBALS['master_port'] = $port;
// break;
// }
} }
/** Update sensor types per port, per subchannel to sysfs (after detection or 10389 EEPROM mask */ /** Update sensor types per port, per subchannel to sysfs (after detection or 10389 EEPROM mask */
...@@ -896,6 +1131,16 @@ function update_sysfs_sensors() ...@@ -896,6 +1131,16 @@ function update_sysfs_sensors()
fclose ( $f ); fclose ( $f );
} }
} }
if ($GLOBALS['port_mux']){
for ($port=0; $port < 4; $port++){
$f = fopen ( $GLOBALS['sysfs_detect_sensors'] . '/port_mux' . $port, 'w' );
fprintf($f,"%s",$GLOBALS['port_mux'][$port]);
fclose ( $f );
}
}
// re-read from sysfs, re-set $GLOBALS['ports'] and $GLOBALS['master_port']
get_sysfs_sensors();
log_msg ("Updated sysfs sensor map");
} }
...@@ -903,7 +1148,7 @@ function log_open(){ ...@@ -903,7 +1148,7 @@ function log_open(){
$GLOBALS['logFile'] = fopen ( $GLOBALS['logFilePath'], "a" ); $GLOBALS['logFile'] = fopen ( $GLOBALS['logFilePath'], "a" );
} }
function log_msg($msg,$any_length=0) { function log_msg($msg,$any_length=0) {
// if ($any_length || ((!array_key_exists('REQUEST_METHOD',$_SERVER)) && (strlen ($msg) < $GLOBALS['LOG_MAX_ECHO']))){ // do not output log when in HTTP request mode
if (!array_key_exists('REQUEST_METHOD',$_SERVER) && ( $any_length || (strlen ($msg) < $GLOBALS['LOG_MAX_ECHO']))){ if (!array_key_exists('REQUEST_METHOD',$_SERVER) && ( $any_length || (strlen ($msg) < $GLOBALS['LOG_MAX_ECHO']))){
echo '(autocampars) '.$msg."\n"; echo '(autocampars) '.$msg."\n";
} }
...@@ -922,114 +1167,52 @@ function log_close() { ...@@ -922,114 +1167,52 @@ function log_close() {
unset ( $GLOBALS['logFile'] ); // to catch errors unset ( $GLOBALS['logFile'] ); // to catch errors
} }
/** Closes log file, optianally responxds with XML (if in HTTP mode), exits with 0/1 */
function respond_xml($result,$error=null){
if (array_key_exists('REQUEST_METHOD',$_SERVER)){
$xml = new SimpleXMLElement("<?xml version='1.0' standalone='yes'?><autocampars/>");
if ($result !== ""){ //"" will not be loged/output
if (is_string($result) && ((count($result)==0) || ($result[0] != '"'))){
$result = '"'.$result.'"';
}
$xml->addChild ('result',$result);
}
if ($error){
$xml->addChild ('error','"'.$error.'"');
}
$rslt=$xml->asXML();
header("Content-Type: text/xml");
header("Content-Length: ".strlen($rslt)."\n");
header("Pragma: no-cache\n");
printf($rslt);
}
if ($result !== ""){ //"" will not be loged/output
log_msg(''.$result);
}
if ($error){
log_error($error);
} else {
log_close();
exit (0);
}
}
/* /*
* #define AUTOCAMPARS_CMD_RESTORE 1 /// restore specified groups of parameters from the specified page * #define AUTOCAMPARS_CMD_RESTORE 1 /// restore specified groups of parameters from the specified page
* #define AUTOCAMPARS_CMD_SAVE 2 /// save all current parameters to the specified group (page 0 is write-protected) * #define AUTOCAMPARS_CMD_SAVE 2 /// save all current parameters to the specified group (page 0 is write-protected)
* #define AUTOCAMPARS_CMD_DFLT 3 /// make selected page the default one (used at startup), page 0 OK * #define AUTOCAMPARS_CMD_DFLT 3 /// make selected page the default one (used at startup), page 0 OK
* #define AUTOCAMPARS_CMD_SAVEDFLT 4 /// save all current parameters to the specified group (page 0 is write-protected) and make it default (used at startup) * #define AUTOCAMPARS_CMD_SAVEDFLT 4 /// save all current parameters to the specified group (page 0 is write-protected) and make it default (used at startup)
* #define AUTOCAMPARS_CMD_INIT 5 /// reset sensor/sequencers, restore all parameters from the specified page * #define AUTOCAMPARS_CMD_INIT 5 /// reset sensor/sequencers, restore all parameters from the specified page
*/ */
// / Even as sync happens simultaneously, frame sync is not - it depends on exposure time.
// / So we need to disable autoexposure and set minimal exposure on this camera, restore on exit
function sync2master($timeout = 120, $min_frame_master = 30) {
$hardware_mask = 7; // only 8 frames command buffer in hardware
$fpga_trig_period = 0x7b;
if (! file_exists ( '/var/volatile/state/APPLICATION' ) || ! file_exists ( '/var/volatile/state/APPLICATION_MODE' ))
return - 1;
$application = file_get_contents ( '/var/volatile/state/APPLICATION' );
$IP_shift = (file_get_contents ( '/var/volatile/state/APPLICATION_MODE' ) + 0) % 100; // 0 - SINGLE, 1..3 - Eyesis, 101+ Eyesis4pi, 1001..1003 - E4pi393
if ($application != 'EYESIS')
return 0; // / not supported yet
if ($IP_shift == 1)
return 0; // / it is the master (101 will also get here)
$neteth0 = file ( '/etc/conf.d/net.eth0' );
$this_ip = array ();
foreach ( $neteth0 as $line ) {
if (strpos ( $line, '=' ) !== false) {
$aline = explode ( "=", trim ( $line ) );
if (trim ( $aline [0] == 'IP' )) {
$this_ip = explode ( '.', trim ( $aline [1] ) );
}
}
}
if (count ( $this_ip ) != 4)
return - 1;
$master_ip = $this_ip [0] . '.' . $this_ip [1] . '.' . $this_ip [2] . '.' . ($this_ip [3] - $IP_shift + 1);
$noaexp = array (
"DAEMON_EN" => 0,
"EXPOS" => 1
);
elphel_skip_frames ( $GLOBALS ['sensor_port'], 4 ); // / 3 here is minimum, otherwise DAEMON_EN is still 0 (after init itself)
$saved_autoexp = elphel_get_P_arr ( $GLOBALS ['sensor_port'], $noaexp );
elphel_set_P_arr ( $GLOBALS ['sensor_port'], $noaexp );
elphel_skip_frames ( $GLOBALS ['sensor_port'], 4 ); // / to be sure exposure is applied
echo ('Synchronizing with ' . $master_ip . "\n");
// / Make sure eth0 is up, otherwise wait for $timeout seconds and reboot
$abort_time = time () + $timeout;
$retval = 1;
while ( (time () < $abort_time) && ($retval != 0) ) {
exec ( '/usr/sbin/mii-diag eth0 --status >/dev/null', $output, $retval );
if ($retval != 0) {
echo time () . ": waiting for eth0 to come up\n";
elphel_skip_frames ( $GLOBALS ['sensor_port'], 1 );
}
}
// passthru ('/usr/sbin/mii-diag eth0 --status');
/*
* passthru ('route');
* passthru ('ifconfig');
* passthru ('wget "http://'.$master_ip.':8081/wframe" -O -');
*/
if ($retval != 0) {
echo "Giving up waiting for the eth0 to come up (if you are watching console). Rebooting\n";
exec ( 'reboot -f' );
}
$master_frame = false;
while ( (time () < $abort_time) && (($master_frame === false) || ($master_frame < $min_frame_master)) ) {
$master_frame = file_get_contents ( 'http://' . $master_ip . ':8081/wframe)' ) + 0; // / will wait
if (($master_frame === false) || ($master_frame < $min_frame_master)) {
echo time () . ": waiting for eth0 to come up\n";
elphel_skip_frames ( $GLOBALS ['sensor_port'], 1 );
}
}
if ($master_frame === false) {
echo "Giving up waiting $master_il to respond (if you are watching console). Rebooting\n";
exec ( 'reboot -f' );
}
$this_frame = elphel_get_frame ( $GLOBALS ['sensor_port'] );
echo 'Master frame=' . $master_frame . "\n";
echo 'This frame=' . $this_frame . "\n";
$skip = (1 + $hardware_mask + ($this_frame & $hardware_mask) - ($master_frame & $hardware_mask)) & $hardware_mask;
echo 'skip ' . $skip . " frames\n";
// FIXME: NC393 - replace
/*
* if ($skip>0) {
* elphel_fpga_write($fpga_trig_period,0);/// stop trigger input
* for ($i=0;$i<$skip;$i++) $master_frame=file_get_contents('http://'.$master_ip.':8081/wframe)')+0; /// will wait
* elphel_fpga_write($fpga_trig_period,elphel_get_P_value($GLOBALS['sensor_port'],ELPHEL_TRIG_PERIOD));/// restore trigger
* }
*/
elphel_set_P_value ( $GLOBALS ['sensor_port'], ELPHEL_THIS_FRAME, $master_frame + 0 );
// $master_frame=file_get_contents('http://'.$master_ip.':8081/wframe)')+0; /// will wait
// $this_frame=elphel_get_frame();
// echo "\nafter sync:\n";
// echo 'Master frame='.$master_frame."\n";
// echo 'This frame='.$this_frame."\n";
// / restore (auto)exposure
elphel_set_P_arr ( $GLOBALS ['sensor_port'], $saved_autoexp );
// var_dump($saved_autoexp);
}
function get_application_mode() { function get_application_mode() {
if (!file_exists($GLOBALS['camera_state_path'])) { if (!file_exists($GLOBALS['camera_state_path'])) {
log_msg("initializing state file ".$GLOBALS['camera_state_path']); log_msg("initializing state file ".$GLOBALS['camera_state_path']);
$GLOBALS['camera_state_arr'] = array ( $GLOBALS['camera_state_arr'] = array (
'state' => 'BOOT', 'state' => 'BOOT',
'10389' => '', 'rev10389' => '',
'application' => '', 'application' => '',
'mode' => 0 'mode' => 0
); );
...@@ -1042,7 +1225,7 @@ function get_application_mode() { ...@@ -1042,7 +1225,7 @@ function get_application_mode() {
log_msg("10389 board not present"); log_msg("10389 board not present");
} else { } else {
log_msg ( 'Application - ' . (( string ) $xml->app) . ', mode: ' . (( string ) $xml->mode) . "\n" ); log_msg ( 'Application - ' . (( string ) $xml->app) . ', mode: ' . (( string ) $xml->mode) . "\n" );
$GLOBALS ['camera_state_arr'] ['10389'] = ''.$xml->rev; $GLOBALS ['camera_state_arr'] ['rev10389'] = ''.$xml->rev;
if ((( string ) $xml->app) != '') { if ((( string ) $xml->app) != '') {
$GLOBALS ['camera_state_arr'] ['application'] = ''.$xml->app; $GLOBALS ['camera_state_arr'] ['application'] = ''.$xml->app;
$GLOBALS ['camera_state_arr'] ['mode'] = intval($xml->mode); $GLOBALS ['camera_state_arr'] ['mode'] = intval($xml->mode);
...@@ -1053,9 +1236,41 @@ function get_application_mode() { ...@@ -1053,9 +1236,41 @@ function get_application_mode() {
$GLOBALS['camera_state_arr'] = parse_ini_file ( $GLOBALS['camera_state_path'] ); $GLOBALS['camera_state_arr'] = parse_ini_file ( $GLOBALS['camera_state_path'] );
log_msg("Parsed existing ini file"); log_msg("Parsed existing ini file");
} }
// Is it reboot or specific init stage?
$need_update = false;
foreach ( $_SERVER ['argv'] as $param ) {
if (substr ( $param, 0, 8 ) == "--reboot") {
$GLOBALS['camera_state_arr']['state'] = 'REBOOT';
$need_update = true;
} else if (substr ( $param, 0, 6 ) == "--init") {
$GLOBALS['init'] = true;
if (substr ( $param, 0, 13 ) == "--init_stage=") {
$GLOBALS['camera_state_arr']['state'] = substr ( $param, 13 );
}
$need_update = true;
}
}
if (array_key_exists ( 'reboot', $_GET )){
$GLOBALS['camera_state_arr']['state'] = 'REBOOT';
$GLOBALS['init'] = true;
$need_update = true;
}
if (array_key_exists ( 'init_stage', $_GET )){
$GLOBALS['camera_state_arr']['state'] = $_GET['init_stage'];
$GLOBALS['init'] = true;
$need_update = true;
}
if ($need_update) {
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
}
return $GLOBALS['camera_state_arr']; return $GLOBALS['camera_state_arr'];
} }
function get_mt9p006_mode() { function get_mt9p006_mode() {
$csa=get_application_mode(); $csa=get_application_mode();
// var_dump($csa); // var_dump($csa);
...@@ -1066,96 +1281,205 @@ function get_mt9p006_mode() { ...@@ -1066,96 +1281,205 @@ function get_mt9p006_mode() {
$GLOBALS['STOP_AFTER']=array( $GLOBALS['STOP_AFTER']=array(
'BOOT' => false, 'BOOT' => false,
'POWERED' => false, 'POWERED' => false,
'PRE10359' => false,
'BITSTREAM'=> false, 'BITSTREAM'=> false,
'SENSORS_DETECTED'=> false, 'SENSORS_DETECTED'=> false,
'SENSORS_SYNCHRONIZED'=>false, 'SENSORS_SYNCHRONIZED'=>false,
'PARAMETERS_PRESET'=> false, 'PARAMETERS_PRESET'=> false,
'SEQUENCERS_ADVANCED'=> false, 'SEQUENCERS_ADVANCED'=> false,
'INITIALIZED'=> false); 'INITIALIZED'=> false);
$GLOBALS['camera_state_arr']['is_master'] = 1;
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
return $mode; return $mode;
} }
unset ($GLOBALS ['mt9p006_mode']); unset ($GLOBALS ['mt9p006_mode']);
return 0; return 0;
} }
function get_eyesis_mode() {
/**
* Eyesis application modes:
* 1001 - top, slave, controls own power, default IP = 161
* 1002 - middle, slave, power controlled by bottom, default IP = 162
* 1003 - bottom, master, controls power for middle, default IP = 163
*
* @return unknown|number */
function get_eyesis_mode() { // should be called...
$csa=get_application_mode(); $csa=get_application_mode();
// var_dump($csa); // var_dump($csa);
if ($csa['application'] == 'EYESIS') { $sensor_mask = 0;
if ($csa['application'] == 'Eyesis4pi393') {
$eyesis_mode = intval($csa['mode']); $eyesis_mode = intval($csa['mode']);
$GLOBALS ['eyesis_mode'] = $eyesis_mode; // $GLOBALS ['eyesis_mode'] = $eyesis_mode;
switch ($eyesis_mode){
case 1001 :
$GLOBALS['camera_state_arr']['is_slave'] = 1;
$GLOBALS['camera_state_arr']['eyesis_top'] = 1;
$sensor_mask = 0xf7777; // 3 sensors on each port, 4 port multiplexers
break;
case 1002 :
$GLOBALS['camera_state_arr']['is_slave'] = 1;
$GLOBALS['camera_state_arr']['eyesis_middle'] = 1;
$sensor_mask = 0xf7777; // 3 sensors on each port, 4 port multiplexers
break;
case 1003 :
$GLOBALS['camera_state_arr']['is_master'] = 1;
$GLOBALS['camera_state_arr']['eyesis_bottom'] = 1;
$sensor_mask = 0x1100; // 1 sensors on each port of 2,3
break;
default:
log_err("Unknown Eyesis mode, only 1001, 1002, and 1003 are defined");
}
$GLOBALS['camera_state_arr']['is_eyesis'] = 1;
write_php_ini ($GLOBALS['camera_state_arr'], $GLOBALS['camera_state_path'] );
$GLOBALS['STOP_AFTER']=array( $GLOBALS['STOP_AFTER']=array(
'BOOT' => true, 'BOOT' => true,
'POWERED' => true, 'POWERED' => true,
'BITSTREAM'=> true, 'PRE10359' => false,
'BITSTREAM'=> false,
'SENSORS_DETECTED'=> true, 'SENSORS_DETECTED'=> true,
'SENSORS_SYNCHRONIZED'=>true, 'SENSORS_SYNCHRONIZED'=>true,
'PARAMETERS_PRESET'=> true, 'PARAMETERS_PRESET'=> true,
'SEQUENCERS_ADVANCED'=> true, 'SEQUENCERS_ADVANCED'=> true,
'INITIALIZED'=> true); 'INITIALIZED'=> true);
return $eyesis_mode; return $sensor_mask;
} }
unset ($GLOBALS ['eyesis_mode']); // unset ($GLOBALS ['eyesis_mode']);
unset ($GLOBALS['camera_state_arr']['is_eyesis']);
return 0; return 0;
} }
function is_eyesis_master(){
// return ($GLOBALS ['eyesis_mode'] == 1003);
return ($GLOBALS['camera_state_arr']['is_eyesis'] && $GLOBALS['camera_state_arr']['is_master']);
}
function detectSensor() { function is_eyesis_slave(){
global $logFile, $framepars_path; // return ($GLOBALS ['eyesis_mode'] == 1001) || ($GLOBALS ['eyesis_mode'] == 1002);
$maxWait = 5.0; // /sec return ($GLOBALS['camera_state_arr']['is_eyesis'] && $GLOBALS['camera_state_arr']['is_slave']);
$waitDaemons = 5.0; // / Wait for daemons to stop (when disabled) before resetting frame number. }
// / They should look at thei enable bit periodically and restart if the frame is
// / the frame is not what they were expecting to be function set_eyesis_power_control(){
$sleepOnce = 0.1; exec ( 'autocampars.py localhost pyCmd disable_gpio_10389', $output, $retval );
// / Here trying full reset with zeroing the absolute frame number, setting all frame parameters to 0 and starting $xml = simplexml_load_string (json_decode(implode(" ",$output))[0]); // just first of outputs (more will be for multiple requests)
$framepars_file = fopen ( $framepars_path, "r" ); return array ('result'=> ((string) $xml->result), 'retval' => $retval);
// /TODO: Improve sequence here so it will not depend on delays }
fseek ( $framepars_file, ELPHEL_LSEEK_FRAMEPARS_INIT, SEEK_END ); // / NOTE: resets all the senor parameters (tasklet control) function my_IP(){
// / elphel_set_P_value($GLOBALS['sensor_port'],ELPHEL_SENSOR, 0x00, 0, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC);/// set sensor to 0 will start detection exec('ifconfig eth0',$output,$retval);
echo "before reset - current frame=" . elphel_get_frame ( $GLOBALS ['sensor_port'] ) . "\n"; return explode(':',explode(" ",trim($output[1]))[1])[1];
// elphel_set_P_value($GLOBALS['sensor_port'],ELPHEL_SENSOR, 0x00, 0, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC);/// set sensor to 0 will start detection }
elphel_set_P_value ( $GLOBALS ['sensor_port'], ELPHEL_SENSOR, 0x00, elphel_get_frame ( $GLOBALS ['sensor_port'] ), ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC ); // / set sensor to 0 will start detection
fseek ( $framepars_file, ELPHEL_LSEEK_SENSORPROC, SEEK_END ); // / In case the autoprocessing after parameter write will be disabled in the future function offset_IP($offset){
// / (normally parameters are processed at frame sync interrupts - not yet available) $aIP=explode('.',my_IP());
fclose ( $framepars_file ); $aIP[3]= (string) ($offset +((int) $aIP[3]));
// / Sensor should be up and running. let's wait for up to $maxWait seconds return implode('.',$aIP);
for($t = 0; elphel_get_frame ( $GLOBALS ['sensor_port'] ) == 0; $t += $sleepOnce) { }
usleep ( $sleepOnce * 1000000 ); function eyesis_get_IPs(){
if ($t > $maxWait) { if (!is_eyesis_master()) return array();
fwrite ( $GLOBALS['logFile'], "Sensor failed to initialize at " . date ( "F j, Y, g:i a" ) . "\n" ); return array ('ip_top' => offset_IP(-2),
fclose ( $GLOBALS['logFile'] ); 'ip_middle' => offset_IP(-1),
exec ( 'sync' ); 'ip_bottom' => my_IP());
return false; // / sensor timeout }
function get_remote_states($IPs){
exec ( 'autocampars.py ['.implode(',',$IPs).'] pyCmd state', $output, $retval );
$states=array();
// print_r($output);
// echo __LINE__."implode(' ',output) = ".implode(" ",$output)."\n\n";
// print_r(json_decode(implode(" ",$output)));
foreach (json_decode(implode(" ",$output)) as $i=>$s) {
// echo "### $i: ".print_r($s,1);
$xml = simplexml_load_string ($s);
// echo "#$i "; print_r($xml);
$states[$i]=array();
foreach ($xml as $tag=>$value){
$svalue=(string) $value;
if (strlen($svalue) > 0){
if ($svalue[0] == '"') $states[$i][$tag] = trim($svalue,'"');
else $states[$i][$tag] = (int) $svalue;
} }
} }
return true; // / Sensor started OK }
// print_r($states);
return $states;
}
// Wait for both slave modules to be in 'BOOT' state
function wait_slaves_boot($retries){
if (!array_key_exists('REQUEST_METHOD',$_SERVER)){
echo 'Waiting for slaves to come up: ';
}
for ($retry = 0; $retry < $retries; $retry++){
if (!array_key_exists('REQUEST_METHOD',$_SERVER)){
echo "$retry ";
}
$states = get_remote_states(array(
$GLOBALS['camera_state_arr']['ip_top'],
$GLOBALS['camera_state_arr']['ip_middle']
));
if (count($states)==2){ // need both to reply
if (array_key_exists('state', $states[0]) &&
array_key_exists('state', $states[1]) &&
!array_key_exists('autocampars', $states[0]) && // autocampars.php should already terminate
!array_key_exists('autocampars', $states[1])){
// if (($states[0]['state']!='BOOT') || ($states[1]['state']!='BOOT')){
break; // wrong state - need system reboot TODO: Add slave reboot by master
// }
}
}
}
if (!array_key_exists('REQUEST_METHOD',$_SERVER)){
echo " Done\n";
}
log_msg("In wait_slaves_boot() states = ".print_r($states,1));
if (($states[0]['state'] == 'BOOT') || ($states[1]['state'] == 'BOOT')) return true;
return $states;
} }
/** Appllies to all sensors */ function reboot_all_if_master(){
function processInit($initPage, $needDetection = true) { $reply_xml=array_key_exists ( 'reboot', $_GET );
$waitDaemons = 5.0; // / Wait for daemons to stop (when disabled) before resetting frame number. log_msg('Current state: '. print_r($GLOBALS['camera_state_arr'],1));
// / They should look at thei enable bit periodically and restart if the frame is
// / the frame is not what they were expecting to be
if (elphel_get_frame ( $GLOBALS['master_port'] ) > 16) { // =1 after initialization
log_msg ( "Current frame on master port =" . elphel_get_frame ( $GLOBALS ['master_port'] ) . ", sleeping to give daemons a chance");
elphel_set_P_value ( $GLOBALS ['master_port'], ELPHEL_COMPRESSOR_RUN, 0x00, 0, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC ); // / turn compressor off
foreach ($GLOBALS['ports'] as $port) { if ($GLOBALS['camera_state_arr']['is_master']){
elphel_set_P_value ( $port, ELPHEL_DAEMON_EN, 0x00, 0, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC ); // / turn daemons off $IPs=array();
foreach ($GLOBALS['camera_state_arr'] as $key=>$ip){
if (substr ( $key, 0, 3 ) == "ip_"){
$IPs[]=$ip;
} }
usleep ( $waitDaemons * 1000000 );
log_msg("Current frame on master port =" . elphel_get_frame ( $GLOBALS ['master_port'] ) . ", waking up, daemons should be dead already");
} }
if (count($IPs) == 0){
$IPs[]='localhost';
}
if ($reply_xml) {
printf ( "<?xml version=\"1.0\"?><root><reboot>Rebooting...</reboot></root>\n" );
}
log_msg('running autocampars.py ['.implode(',',$IPs).'] pyCmd reboot');
exec ( 'autocampars.py ['.implode(',',$IPs).'] pyCmd reboot', $output, $retval );
exit(0); // no time to close log
}
respond_xml('','Only master can reboot'); // will exit(1)
}
log_msg("after reset - current frame on master port =" . elphel_get_frame ( $GLOBALS ['master_port'] )); function eyesis_all_power_fpga($include){
if ($GLOBALS['camera_state_arr']['is_master']){
$IPs=array();
foreach ($GLOBALS['camera_state_arr'] as $key=>$ip){
if (substr ( $key, 0, 3 ) == "ip_"){
$IPs[]=$ip;
}
}
if (count($IPs) == 0){
$IPs[]='localhost';
}
// $GLOBALS['sensor_port']!!!!!!!!!!! log_msg('running autocampars.py ['.implode(',',$IPs).'] py393 '.$include);
$pages = setParsFromPage (-1, $initPage, 0x1, true ); // /only init parameters? exec ( 'autocampars.py ['.implode(',',$IPs).'] py393 '.$include, $output, $retval );
log_msg("after setParsFromPage - current frame on master port=" . elphel_get_frame ( $GLOBALS ['master_port'] )); return true;
return $pages; }
return false;
} }
function processDaemon($port) { function processDaemon($port) {
//TODO: Make sure $port >=0 //TODO: Make sure $port >=0
$AUTOCAMPARS = elphel_get_P_arr ( $GLOBALS ['sensor_port'], array ( $AUTOCAMPARS = elphel_get_P_arr ( $GLOBALS ['sensor_port'], array (
...@@ -1313,6 +1637,10 @@ WARN; ...@@ -1313,6 +1637,10 @@ WARN;
exit ( 1 ); exit ( 1 );
} }
$page_title = "Model 393 Camera Parameters save/restore, sensor port {$port}"; $page_title = "Model 393 Camera Parameters save/restore, sensor port {$port}";
startPage ( $page_title, mainJavascript ($port) ); startPage ( $page_title, mainJavascript ($port) );
if ($GLOBALS['twoColumns']) if ($GLOBALS['twoColumns'])
...@@ -1556,7 +1884,7 @@ function getMaskedPars($port_page, ///< array of parameter pages indexed by port ...@@ -1556,7 +1884,7 @@ function getMaskedPars($port_page, ///< array of parameter pages indexed by port
} }
function setParsFromPage($sensor_port, $page, $mask, $initmode = false) { function setParsFromPage($sensor_port, $page, $mask) {
// If init_mode - will set all ports, $sensor_port will be ignored // If init_mode - will set all ports, $sensor_port will be ignored
// will return an array of pages, matching $GLOBALS['ports'] array // will return an array of pages, matching $GLOBALS['ports'] array
// /FIXME: !!! // /FIXME: !!!
...@@ -1564,145 +1892,7 @@ function setParsFromPage($sensor_port, $page, $mask, $initmode = false) { ...@@ -1564,145 +1892,7 @@ function setParsFromPage($sensor_port, $page, $mask, $initmode = false) {
// / AS there is a hardware limit of 64 parameters/frame in the sequencers (64 for the i2c, 64 - for the FPGA registers) // / AS there is a hardware limit of 64 parameters/frame in the sequencers (64 for the i2c, 64 - for the FPGA registers)
// For that it is possible to use ASAP mode - driver will wait for the i2c command to be sent // For that it is possible to use ASAP mode - driver will wait for the i2c command to be sent
log_msg("setParsFromPage($sensor_port, $page, $mask, $initmode)"); log_msg("setParsFromPage($sensor_port, $page, $mask)");
if ($initmode) {
//$GLOBALS['configs']
// New way (for nc393)
$delayed_par_names=array("TRIG", "TRIG_PERIOD", "TRIG_CONDITION", "TRIG_MASTER");
$pages=array();
foreach ( $GLOBALS['ports'] as $port ) {
if ($page == $GLOBALS ['useDefaultPageNumber']) {
$page = $GLOBALS ['configs'] [$port] ['defaultPage'];
}
$parToSet = array ();
foreach ( $GLOBALS ['configs'] [$port] ['groups'] as $par => $parMask ) {
if (($mask & $parMask) && array_key_exists ( $par, $GLOBALS ['configs'] [$port] ['paramSets'] [$page] ) && (! $GLOBALS ['configs'] [$port] ['parTypes'] [$par])) // / not 'text'
$parToSet [$par] = myval ( $GLOBALS ['configs'] [$port] ['paramSets'] [$page] [$par] );
}
// /NOTE: Important ; add gamma tables if parameters modified involve setting/changing them
addGammas ( $parToSet );
$delayed_params = array ();
// Separate $delayed_par_names from other values,
foreach ( $parToSet as $key => $value ) {
if (in_array ( $key, $delayed_par_names )) {
$delayed_params [$key] = $value;
unset ( $parToSet [$key] );
}
}
// Similar things for nc353
$compressor_run = array (
'COMPRESSOR_RUN' => 2
);
$sensor_run = array (
'SENSOR_RUN' => 2
);
$daemon_en = array (
'DAEMON_EN_AUTOEXPOSURE' => 1,
'DAEMON_EN_STREAMER' => 1,
'DAEMON_EN_CCAMFTP' => 0,
'DAEMON_EN_CAMOGM' => 0,
'DAEMON_EN_TEMPERATURE' => 0
);
if (isset ( $parToSet ['SENSOR_RUN'] )) {
$sensor_run ['SENSOR_RUN'] = $parToSet ['SENSOR_RUN'];
unset ( $parToSet ['SENSOR_RUN'] );
}
if (isset ( $parToSet ['COMPRESSOR_RUN'] )) {
$compressor_run ['COMPRESSOR_RUN'] = $parToSet ['COMPRESSOR_RUN'];
unset ( $parToSet ['COMPRESSOR_RUN'] );
}
if (isset ( $parToSet ['DAEMON_EN'] )) {
$daemon_en ['DAEMON_EN'] = $parToSet ['DAEMON_EN'];
unset ( $parToSet ['DAEMON_EN'] );
}
if (isset ( $parToSet ['DAEMON_EN_AUTOEXPOSURE'] )) {
$daemon_en ['DAEMON_EN_AUTOEXPOSURE'] = $parToSet ['DAEMON_EN_AUTOEXPOSURE'];
unset ( $parToSet ['DAEMON_EN_AUTOEXPOSURE'] );
}
if (isset ( $parToSet ['DAEMON_EN_STREAMER'] )) {
$daemon_en ['DAEMON_EN_STREAMER'] = $parToSet ['DAEMON_EN_STREAMER'];
unset ( $parToSet ['DAEMON_EN_STREAMER'] );
}
if (isset ( $parToSet ['DAEMON_EN_CCAMFTP'] )) {
$daemon_en ['DAEMON_EN_CCAMFTP'] = $parToSet ['DAEMON_EN_CCAMFTP'];
unset ( $parToSet ['DAEMON_EN_CCAMFTP'] );
}
if (isset ( $parToSet ['DAEMON_EN_CAMOGM'] )) {
$daemon_en ['DAEMON_EN_CAMOGM'] = $parToSet ['DAEMON_EN_CAMOGM'];
unset ( $parToSet ['DAEMON_EN_CAMOGM'] );
}
if (isset ( $parToSet ['DAEMON_EN_TEMPERATURE'] )) {
$daemon_en ['DAEMON_EN_TEMPERATURE'] = $parToSet ['DAEMON_EN_TEMPERATURE'];
unset ( $parToSet ['DAEMON_EN_TEMPERATURE'] );
}
if (isset ( $daemon_en ['DAEMON_EN'] )) {
if (isset ( $daemon_en ['DAEMON_EN_AUTOEXPOSURE'] ))
$daemon_en ['DAEMON_EN'] |= $daemon_en ['DAEMON_EN_AUTOEXPOSURE'] ? 1 : 0;
if (isset ( $daemon_en ['DAEMON_EN_STREAMER'] ))
$daemon_en ['DAEMON_EN'] |= $daemon_en ['DAEMON_EN_STREAMER'] ? 2 : 0;
if (isset ( $daemon_en ['DAEMON_EN_CCAMFTP'] ))
$daemon_en ['DAEMON_EN'] |= $daemon_en ['DAEMON_EN_CCAMFTP'] ? 4 : 0;
if (isset ( $daemon_en ['DAEMON_EN_CAMOGM'] ))
$daemon_en ['DAEMON_EN'] |= $daemon_en ['DAEMON_EN_CAMOGM'] ? 8 : 0;
if (isset ( $daemon_en ['DAEMON_EN_TEMPERATURE'] ))
$daemon_en ['DAEMON_EN'] |= $daemon_en ['DAEMON_EN_TEMPERATURE'] ? 32 : 0;
}
$frame_to_set = elphel_get_frame ( $GLOBALS ['master_port'] ) + 0; // ELPHEL_CONST_FRAME_DEAFAULT_AHEAD;
// If it was called from already running
if (elphel_get_P_value ( $port, ELPHEL_COMPRESSOR_RUN ) || elphel_get_P_value ( $port, ELPHEL_DAEMON_EN )) {
$frame_to_set += ELPHEL_CONST_FRAME_DEAFAULT_AHEAD;
// Should we stop sequencers?
elphel_set_P_arr ( $port, array (
'COMPRESSOR_RUN' => 0,
'SENSOR_RUN' => 0,
'DAEMON_EN' => 0
), $frame_to_set, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC ); // was -1 ("this frame")
// advance frames, so next settings will be ASAP (sent immediate, not limited to 64?)
for ($i = 0; $i< ELPHEL_CONST_FRAME_DEAFAULT_AHEAD; $i++){
// Single trigger
elphel_set_P_value ( $GLOBALS['master_port'], ELPHEL_TRIG_PERIOD, 1, ELPHEL_CONST_FRAME_IMMED, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC);
usleep ($GLOBALS['camera_state_arr']['max_frame_time']); // > 1 frame, so all channels will get trigger parameters? 3 2 2 1 -> 4 3 3 2
}
}
log_msg ( "port ".$port. " \$frame_to_set=".$frame_to_set.", now= " . elphel_get_frame ( $GLOBALS ['master_port']));
log_msg ( "port ".$port. " setting @".$frame_to_set.": " .print_r($parToSet,1));
// set all in ASAP mode
elphel_set_P_arr ( $port, $parToSet, $frame_to_set, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC );
$frame_to_set += 2;
log_msg ( "port ".$port. " setting @".$frame_to_set." SENSOR_RUN= " . $sensor_run ['SENSOR_RUN']);
elphel_set_P_arr ( $port, $sensor_run, $frame_to_set, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC );
$frame_to_set += 2;
log_msg ( "port ".$port. " setting @".$frame_to_set." COMPRESSOR_RUN= " . $compressor_run ['COMPRESSOR_RUN']);
elphel_set_P_arr ( $port, $compressor_run, $frame_to_set, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC );
$frame_to_set += 4; // /Adjust? So streamer will have at least 2 good frames in buffer?
log_msg ( "port ".$port. " setting @".$frame_to_set." DAEMON_EN= " . print_r ( $daemon_en, 1 ));
elphel_set_P_arr ( $port, $daemon_en, $frame_to_set, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC );
$frame_to_set += 1;
log_msg ("port ".$port. " setting @".$frame_to_set." delayed trigger parameters= " . print_r ( $delayed_params, 1 ) );
elphel_set_P_arr ( $port, $delayed_params, $frame_to_set, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC );
$pages[]=$page;
}
$numSkip=$frame_to_set-elphel_get_frame($GLOBALS['master_port'])+1; // +1 - to be safe?
log_msg("Skipping ".$numSkip." frames");
for ($i = 0; $i< $numSkip; $i++){
// Single trigger
elphel_set_P_value ( $GLOBALS['master_port'], ELPHEL_TRIG_PERIOD, 1, ELPHEL_CONST_FRAME_IMMED, ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC);
usleep ($GLOBALS['camera_state_arr']['max_frame_time']); // > 1 frame, so all channels will get trigger parameters? 3 2 2 1 -> 4 3 3 2
}
// restore periodic FPGA trigger after using single-trigger:
if (array_key_exists('TRIG_PERIOD',$delayed_params)){
elphel_set_P_value ( $GLOBALS['master_port'],
ELPHEL_TRIG_PERIOD,
$delayed_params['TRIG_PERIOD'],
ELPHEL_CONST_FRAME_IMMED,
ELPHEL_CONST_FRAMEPAIR_FORCE_NEWPROC);
}
return $pages;
} else {
if ($page == $GLOBALS['useDefaultPageNumber']) { if ($page == $GLOBALS['useDefaultPageNumber']) {
$page = $GLOBALS['configs'][$sensor_port]['defaultPage']; $page = $GLOBALS['configs'][$sensor_port]['defaultPage'];
} }
...@@ -1719,23 +1909,9 @@ function setParsFromPage($sensor_port, $page, $mask, $initmode = false) { ...@@ -1719,23 +1909,9 @@ function setParsFromPage($sensor_port, $page, $mask, $initmode = false) {
addGammas ( $parToSet ); addGammas ( $parToSet );
log_msg('$parToSet == '. print_r($parToSet,1)); log_msg('$parToSet == '. print_r($parToSet,1));
elphel_set_P_arr ( $sensor_port, $parToSet ); elphel_set_P_arr ( $sensor_port, $parToSet );
}
return $page; return $page;
} }
/*
global $config, $useDefaultPageNumber;
if ($page==$useDefaultPageNumber) $page=$config['defaultPage'];
$parToSet=array();
foreach ($config['groups'] as $par=>$parMask) {
if (($mask & $parMask) &&
array_key_exists($par, $config['paramSets'][$page]) &&
(!$config['parTypes'][$par])) /// not 'text'
$parToSet[$par]=myval($config['paramSets'][$page][$par]);
}
///NOTE: Important ; add gamma tables if parameters modified involve setting/chnaging them
addGammas($parToSet);
*/
function readParsToPage($sensor_port, $page) { function readParsToPage($sensor_port, $page) {
log_msg("readParsToPage($sensor_port, $page)"); log_msg("readParsToPage($sensor_port, $page)");
...@@ -1973,9 +2149,6 @@ function calculateDefaultPhases() { ...@@ -1973,9 +2149,6 @@ function calculateDefaultPhases() {
//http://stackoverflow.com/questions/5695145/how-to-read-and-write-to-an-ini-file-with-php //http://stackoverflow.com/questions/5695145/how-to-read-and-write-to-an-ini-file-with-php
function write_php_ini($array, $file) { function write_php_ini($array, $file) {
// echo "write_php_ini\n";
// var_dump($array);
// print_r($array);
$res = array (); $res = array ();
foreach ( $array as $key => $val ) { foreach ( $array as $key => $val ) {
if (is_array ( $val )) { if (is_array ( $val )) {
...@@ -2008,6 +2181,78 @@ function safefilerewrite($fileName, $dataToSave) { ...@@ -2008,6 +2181,78 @@ function safefilerewrite($fileName, $dataToSave) {
fclose ( $fp ); fclose ( $fp );
} }
} }
// Using parallel requests, PHP has to be configured '--with-curl=' (and libcurl should be installed)
function curl_multi_start($urls) {
// numprime is needed to actually send the request and remote starts executing it
// Not really clear - what it should be
$numprime = 4; // magic number, see http://lampe2e.blogspot.com/2015/03/making-stuff-faster-with-curlmultiexec.html
$curl_mh = curl_multi_init ();
$aCurlHandles = array ();
foreach ($urls as $url) {
$ch = curl_init ();
curl_setopt ($ch, CURLOPT_URL, $url);
curl_setopt ($ch, CURLOPT_RETURNTRANSFER, 1);
curl_setopt ($ch, CURLOPT_HEADER, 0);
$aCurlHandles[] = $ch;
curl_multi_add_handle ($curl_mh, $ch);
}
$curl_active = count ($urls);
for($x = 0; $x < $numprime && $curl_active; $x++) {
curl_multi_exec ($curl_mh, $curl_active);
// we wait for a bit to allow stuff TCP handshakes to complete and so forth...
usleep (10000);
echo ".";
}
return array ("mh" => $curl_mh,"handles" => $aCurlHandles);
}
function curl_multi_finish($data, $use_xml=true, $ntry=0, $echo = false) {
$curl_active = 1;
$curl_mrc = CURLM_OK;
$nrep = 0;
$curl_mh = $data['mh'];
while ($curl_active && $curl_mrc == CURLM_OK ) {
if (curl_multi_select ($curl_mh) != -1) {
do {
$curl_mrc = curl_multi_exec ($curl_mh, $curl_active);
} while ($curl_mrc == CURLM_CALL_MULTI_PERFORM );
}
// if ($echo) echo "$nrep: ($curl_active/$curl_mrc) ";
if ($echo) echo "$curl_active ";
$nrep++;
if ($ntry && ($nrep > $ntry)) {
break;
}
}
$results = array ();
if ($use_xml) {
foreach ($data['handles'] as $i => $ch) {
$xml = simplexml_load_string (curl_multi_getcontent ($ch));
curl_multi_remove_handle ($curl_mh, $ch);
$results[$i] = array ();
foreach ($xml as $tag => $value) {
$svalue = (string) $value;
if (strlen ($svalue) > 0) {
if ($svalue[0] == '"') $results[$i][$tag] = trim ($svalue, '"');
else $results[$i][$tag] = (int) $svalue;
}
}
}
} else {
foreach ($data['handles'] as $i => $ch) {
$r = curl_multi_getcontent ($ch);
curl_multi_remove_handle ($curl_mh, $ch);
$results[] = $r;
}
}
curl_multi_close ($curl_mh);
return $results;
}
function createDefaultConfig($version, $multisensor = false, $eyesis_mode = 0) { // / 0 - not eyesis, 1-3 - camera number function createDefaultConfig($version, $multisensor = false, $eyesis_mode = 0) { // / 0 - not eyesis, 1-3 - camera number
$SENSOR_RUN = ELPHEL_CONST_SENSOR_RUN_CONT; // / turn on sensor in continuous mode $SENSOR_RUN = ELPHEL_CONST_SENSOR_RUN_CONT; // / turn on sensor in continuous mode
$COMPRESSOR_RUN = ELPHEL_CONST_COMPRESSOR_RUN_CONT; // / run compressor in continuous mode $COMPRESSOR_RUN = ELPHEL_CONST_COMPRESSOR_RUN_CONT; // / run compressor in continuous mode
......
src/autocampars.py
View file @ c6bb1fee
...@@ -42,13 +42,16 @@ import urllib2 ...@@ -42,13 +42,16 @@ import urllib2
import xml.etree.ElementTree as ET import xml.etree.ElementTree as ET
import threading import threading
import Queue import Queue
import json
import time import time
import random import random
PYDIR = "/usr/local/bin" PYDIR = "/usr/local/bin"
VERILOG_DIR = "/usr/local/verilog" VERILOG_DIR = "/usr/local/verilog"
WWW_SCRIPT="autocampars.py" WWW_SCRIPT="autocampars.py"
TIMEOUT = 20 # seconds TIMEOUT = 30 # seconds
GPIO_10389 = "/sys/devices/soc0/elphel393-pwr@0/gpio_10389"
SATA_MODULE_CTRL = "/sys/devices/soc0/amba@0/80000000.elphel-ahci/load_module"
STATE_FILE = "/var/volatile/state/camera"
def process_py393(args): def process_py393(args):
cmd=PYDIR+'/test_mcntrl.py' cmd=PYDIR+'/test_mcntrl.py'
try: try:
...@@ -64,13 +67,160 @@ def process_py393(args): ...@@ -64,13 +67,160 @@ def process_py393(args):
l=0 l=0
rslt= subprocess.call(cmd,shell=True) rslt= subprocess.call(cmd,shell=True)
# rslt = l # rslt = l
fmt="""<?xml version="1.0"?> fmt= '<?xml version="1.0"?><result>%d</result>'
<result>%d</result>
"""
print (fmt%(rslt)) print (fmt%(rslt))
print ('<!--process_py393 (',args,')-->') print ('<!--process_py393 (',args,')-->')
print('<!-- called ',cmd,'-->') print('<!-- called ',cmd,'-->')
def check_process(proc_name):
pass
"""
def restart():
command = "/sbin/shutdown -r now"
# command = "reboot -f"
process = subprocess.Popen(command.split(), stdout=subprocess.PIPE)
output = process.communicate()[0]
"""
def process_pyCmd(args):
xml=None
rslt=""
err=""
try:
fname = args['include'][0] # name of function to call
except:
fname = None
try:
fargs = args['other'][0]
except:
fargs=[]
if not fname:
err="Function to call is not specified"
elif fname == "autocampars": # alternatively will try with wget
r = subprocess.call("autocampars.php --init_stage="+fargs[0], shell=True) # Do not need to capture output - it is in the logs
if not r:
rslt += 'OK'
else:
err = str(r)
elif fname == "reboot":
xml=ET.Element('root')
v=ET.SubElement(xml, 'reboot')
v.text='"started..."'
print ('<?xml version="1.0"?>'+ET.tostring(xml))
sys.stdout.flush()
sys.stdout.close()
command = "/sbin/shutdown -r now" # 'reboot -f' does npot work
process = subprocess.Popen(command.split(), stdout=subprocess.PIPE)
output = process.communicate()[0]
elif fname == "state":
xml=ET.Element('root')
try:
with open (STATE_FILE,"r") as f:
content = f.read()
except Exception, e:
err=str(e)
if not err:
for line in content.split("\n"): #split it into lines
try:
line = line.strip().split('=')
if (len(line) == 2) and (line[0][0] != '#'): # will only ignore leading '#', not inline
key = line[0].strip()
value = line[1].strip()
except:
continue
v=ET.SubElement(xml, key)
v.text=value
# add autocampars.php process if running
try:
if 'autocampars.php' in subprocess.check_output("ps -w",shell=True):
v=ET.SubElement(xml, 'autocampars')
v.text='"Running"'
except Exception, e:
err=str(e)
elif fname == "start_gps_compass":
try:
rslt = subprocess.check_output("start_gps_compass.php",shell=True)
except Exception, e:
err=str(e)
elif fname == "disable_gpio_10389":
with open (GPIO_10389,"w") as f:
print ('0x101',file=f)
f.flush() # otherwise second access is lost !!
print ('0x100',file=f)
time.sleep(1) # check if needed
rslt = "OK"
elif fname == "init_sata":
try:
rslt += subprocess.check_output(PYDIR+"/x393sata.py",shell=True)
subprocess.call("modprobe ahci_elphel &",shell=True)
time.sleep(2) # check if needed
with open (SATA_MODULE_CTRL,"w") as f:
print ('1',file=f)
except Exception, e:
err=str(e)
elif fname == "init_sata_0": #first step
try:
rslt += subprocess.check_output(PYDIR+"/x393sata.py",shell=True)
subprocess.call("modprobe ahci_elphel &",shell=True)
except Exception, e:
err=str(e)
elif fname == "init_sata_1": #second step (after some delay)
try:
with open (SATA_MODULE_CTRL,"w") as f:
print ('1',file=f)
rslt += "OK"
except Exception, e:
err=str(e)
elif fname == "ls": #just for testing
try:
rslt = subprocess.check_output("ls -all",shell=True)
except Exception, e:
err=str(e)
if not xml:
xml=ET.Element('root')
if rslt:
result=ET.SubElement(xml, 'result')
result.text=rslt
if err:
emsg=ET.SubElement(xml, 'error')
emsg.text='"'+err+'"'
print ('<?xml version="1.0"?>'+ET.tostring(xml))
return xml
# print ('<!--process_py393 (',args,')-->')
# print('<!-- called ',cmd,'-->')
def process_shell(args):
xml=ET.Element('root')
rslt=""
err=""
try:
cmd = args['include'][0] # name of function to call
except:
err = 'Shell command is not specified'
try:
fargs = args['other'][0]
except:
fargs=[]
if not err:
cmd += ' '+ ' '.join(str(e) for e in fargs)
try:
rslt += subprocess.check_output(cmd,shell=True)
except Exception, e:
err=str(e)
if rslt:
result=ET.SubElement(xml, 'result')
result.text=rslt
if err:
emsg=ET.SubElement(xml, 'error')
emsg.text='"'+err+'"'
print ('<?xml version="1.0"?>'+ET.tostring(xml))
return xml
def remote_parallel393(args, host, timeout=0): #fp in sec def remote_parallel393(args, host, timeout=0): #fp in sec
if not isinstance(host,(list,tuple)): if not isinstance(host,(list,tuple)):
if not isinstance(args,(list,tuple)): if not isinstance(args,(list,tuple)):
...@@ -80,20 +230,29 @@ def remote_parallel393(args, host, timeout=0): #fp in sec ...@@ -80,20 +230,29 @@ def remote_parallel393(args, host, timeout=0): #fp in sec
if not isinstance(args,(list,tuple)): if not isinstance(args,(list,tuple)):
args=[args]*len(host) args=[args]*len(host)
argshosts=zip(args,host) argshosts=zip(args,host)
print ('remote_parallel393(args=',args,' host=',host,')') ## print ('remote_parallel393(args=',args,' host=',host,')')
print ('argshosts=',argshosts) ## print ('argshosts=',argshosts)
urls=[] urls=[]
for i in argshosts: for i in argshosts:
i[0]['cmd'] = 'py393' # i[0]['cmd'] = 'py393'
urls.append("http://"+i[1]+"/"+WWW_SCRIPT+"?"+urllib.urlencode(i[0])) urls.append("http://"+i[1]+"/"+WWW_SCRIPT+"?"+urllib.urlencode(i[0]))
rslts = remote_parallel_urls(urls=urls, timeout=timeout) results = remote_parallel_urls(urls=urls, timeout=timeout)
for num,result in enumerate(results): ## for num,result in enumerate(results):
print (">>>>> ",num,": ",result); ## print (">>>>> ",num,": ",result);
return rslts print (json.dumps(results)) #Each line... ? Use json?
return results
def remote_parallel_urls(urls, timeout=0): #imeout will restart for each next url def remote_parallel_urls(urls, timeout=0): #imeout will restart for each next url
def read_url(index, queue, url): def read_url(index, queue, url):
try:
queue.put((index, urllib2.urlopen(url).read())) queue.put((index, urllib2.urlopen(url).read()))
except Exception, e:
# create xml with error message
xml = ET.Element('root')
emsg = ET.SubElement(xml, 'error')
emsg.text = '"' + str(e) + '"'
queue.put((index,'<?xml version="1.0"?>'+ET.tostring(xml)))
queue = Queue.Queue() queue = Queue.Queue()
for index, url in enumerate(urls): for index, url in enumerate(urls):
...@@ -107,14 +266,16 @@ def remote_parallel_urls(urls, timeout=0): #imeout will restart for each next ur ...@@ -107,14 +266,16 @@ def remote_parallel_urls(urls, timeout=0): #imeout will restart for each next ur
try: try:
rslt = queue.get(block=True, timeout=timeout) rslt = queue.get(block=True, timeout=timeout)
rslts[rslt[0]] = rslt[1] rslts[rslt[0]] = rslt[1]
except: except Exception, e:
# print ("***** Error: ",str(e),rslt) ## Only timeout errors should be here
break break
## print("*** remote_parallel_urls(): got ",rslts)
return rslts return rslts
#if None in rslts - likely timeout happened #if None in rslts - likely timeout happened
def remote_wget(url, host, timeout=0) : #split_list_arg(sys.argv[1])) def remote_wget(url, host, timeout=0) : #split_list_arg(sys.argv[1]))
print ("remote_wget(",args,',',host,')') # print ("remote_wget(",url,',',host,')')
if not isinstance(host,(list,tuple)): if not isinstance(host,(list,tuple)):
host=[host] host=[host]
if len(host) > len(url): if len(host) > len(url):
...@@ -122,14 +283,15 @@ def remote_wget(url, host, timeout=0) : #split_list_arg(sys.argv[1])) ...@@ -122,14 +283,15 @@ def remote_wget(url, host, timeout=0) : #split_list_arg(sys.argv[1]))
elif len(url) > len(url): elif len(url) > len(url):
host += [host[-1]]*(len(url) - len(host)) host += [host[-1]]*(len(url) - len(host))
argshosts=zip(args,host) argshosts=zip(url,host)
print ('remote_wget(args=',args,' host=',host,')') # print ('remote_wget(url=',url,' host=',host,')')
print ('argshosts=',argshosts) # print ('argshosts=',argshosts)
urls=[] urls=[]
for i in argshosts: for i in argshosts:
urls.append("http://"+i[1]+"/"+i[0]) urls.append("http://"+i[1]+"/"+i[0])
rslts=remote_parallel_urls(urls=urls, timeout=timeout) rslts=remote_parallel_urls(urls=urls, timeout=timeout)
# parse results here # parse results here
print (json.dumps(rslts)) #Each line... ? Use json?
return rslts return rslts
def process_http(): def process_http():
...@@ -143,6 +305,12 @@ def process_http(): ...@@ -143,6 +305,12 @@ def process_http():
if qs['cmd'][0] == 'py393': if qs['cmd'][0] == 'py393':
process_py393(qs) process_py393(qs)
return return
elif qs['cmd'][0] == 'pyCmd':
process_pyCmd(qs)
return
elif qs['cmd'][0] == 'shell':
process_shell(qs)
return
except: except:
pass pass
...@@ -153,10 +321,18 @@ def split_list_arg(arg): ...@@ -153,10 +321,18 @@ def split_list_arg(arg):
return arg return arg
def process_cmdline(): def process_cmdline():
print('sys.argv = ',sys.argv) # print('sys.argv = ',sys.argv)
print('sys.argv[1] = ',split_list_arg(sys.argv[1])) # print('sys.argv[1] = ',split_list_arg(sys.argv[1]))
args={} args={}
if sys.argv[2] == "py393": """
py393 <include file> <other parameters> -> test_mcntrl @<include file> <other parameters>
pyCmd <function name> <arguments>
shell <external-command-to-call> <arguments>
"""
if (sys.argv[2] == "py393") or (sys.argv[2] == "pyCmd") or (sys.argv[2] == "shell"):
args['cmd'] = sys.argv[2] # added
try: try:
args['include'] =sys.argv[3] args['include'] =sys.argv[3]
except: except:
...@@ -166,14 +342,21 @@ def process_cmdline(): ...@@ -166,14 +342,21 @@ def process_cmdline():
args['other'] =' '.join(sys.argv[4:]) args['other'] =' '.join(sys.argv[4:])
except: except:
pass pass
print ('args=',args) ## print ('args=',args)
remote_parallel393 (args=args, host = split_list_arg(sys.argv[1]), timeout=TIMEOUT) remote_parallel393 (args=args, host = split_list_arg(sys.argv[1]), timeout=TIMEOUT)
elif sys.argv[2] == "wget": elif sys.argv[2] == "wget":
urls = sys.argv[3:] urls = sys.argv[3:]
remote_wget(urls, split_list_arg(sys.argv[1])) remote_wget(urls, split_list_arg(sys.argv[1]))
elif sys.argv[2] == "same_cmd":
urls = sys.argv[3:]
remote_wget(urls, split_list_arg(sys.argv[1]))
else: else:
pass pass
def main(): def main():
if 'REQUEST_METHOD' in os.environ: if 'REQUEST_METHOD' in os.environ:
return process_http() return process_http()
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment