Commit e7c0ea42 authored by Andrey Filippov's avatar Andrey Filippov

debugging scan

parent 5bccccf6
......@@ -15,6 +15,8 @@ $AZ_CMAX = 4790;
$EL_CMAX = 10979;
$SK_CMAX = 931;
$MODEM_THRESHOLD = 17.0; // consider something if modem strength is above
$OVERSHOOT = 1; // final steps absolute error
$LATE_STOP_AZ = 30; // steps
/*
http://192.168.1.250/motor.xml?Action=ElUp&Distance=0.5&Units=1 0.5 degree up
......@@ -177,17 +179,17 @@ string(61) "http://192.168.1.250/motor.xml?Action=ElDn&Distance=1&Units=0"
$dbg_file = fopen("/home/eyesis/git/motosat/attic/logs/modem.log","w");
fprintf($dbg_file,"test log\n");
print("<p>".date('l jS \of F Y h:i:s A')."</p>");
$modem_strength= getModemStrength();
for ($i=0;$i<10;$i++){
if (false) {
print("<p>".date('l jS \of F Y h:i:s A')."</p>");
$modem_strength= getModemStrength();
for ($i=0;$i<10;$i++){
//$modem_strength= getModemStrength();
$xml_state = simplexml_load_file($motosat_url); // 0.29 sec
}
print("<p>modem_strength=".$modem_strength." file=".$modem_strengt_url."</p>");
print("<p>".date('l jS \of F Y h:i:s A')."</p>");
exit (0);
}
print("<p>modem_strength=".$modem_strength." file=".$modem_strengt_url."</p>");
print("<p>".date('l jS \of F Y h:i:s A')."</p>");
exit (0);
$xml_state = simplexml_load_file($motosat_url);
......@@ -224,7 +226,7 @@ if ($scan_mode){
$xml = new SimpleXMLElement("<?xml version='1.0'?><motosat/>");
$State = $xml_state->State+0; // 1 - Ready, 2 - Busy
$busy = ($State & 2) != 0;
$SignalQuality = (explode(",",myfval($xml_state->SignalQuality)[0]));
$SignalQuality = myfval(explode(",",$xml_state->SignalQuality)[0]);
$DishCount = $xml_state->DishCount;
$DishAngle = $xml_state->DishAngle;
$Success = $xml_state->Success;
......@@ -281,31 +283,99 @@ $SK_CMAX = 931;
*/
function scan_window($threshold, $DishAngleCenter, $wnd_az, $wnd_el, $scan_step){
global $motosat_url;
global $motosat_url,$LATE_STOP_AZ,$dbg_file;
$DishAngle = Array($DishAngleCenter[0],$DishAngleCenter[1],$DishAngleCenter[2]);
$pass = 0;
for ($DishAngle[1] = $DishAngleCenter[1] - $wnd_el/2;
$DishAngle[1] <= ($DishAngleCenter[1] + $wnd_el/2);
$DishAngle[1]+= $scan_step) {
if ($pass & 1) {
$az_start = $DishAngleCenter[1] + $wnd_el/2;
$az_end = $DishAngleCenter[1] - $wnd_el/2;
$az_start = $DishAngleCenter[0] + $wnd_az/2;
$az_end = $DishAngleCenter[0] - $wnd_az/2;
} else {
$az_start = $DishAngleCenter[1] - $wnd_el/2;
$az_end = $DishAngleCenter[1] + $wnd_el/2;
$az_start = $DishAngleCenter[0] - $wnd_az/2;
$az_end = $DishAngleCenter[0] + $wnd_az/2;
}
$DishAngle[0] = $az_start;
moveElAzSk_degrees($DishAngle);
if ($dbg_file) {
fprintf($dbg_file, "\npass=%d:\n",$pass);
fprintf($dbg_file, "wnd_az=%f:\n",$wnd_az);
fprintf($dbg_file, "wnd_el=%f:\n",$wnd_el);
fprintf($dbg_file, "threshold=%f:\n",$threshold);
fprintf($dbg_file, "scan_step=%f:\n",$scan_step);
fprintf($dbg_file, "DishAngle - start:\n");
fprintf($dbg_file, print_r($DishAngle,1));
fprintf($dbg_file, "DishAngleCenter - start:\n");
fprintf($dbg_file, print_r($DishAngleCenter,1));
}
// while (true) {
// $counts = moveElAzSk_degrees($DishAngle);
// if (!isset($counts)) break;
// }
while (null !==moveElAzSk_degrees($DishAngle));
$DishAngle[0] = $az_end;
if ($dbg_file) {
fprintf($dbg_file, "\nDishAngle - end:\n");
fprintf($dbg_file, print_r($DishAngle,1));
}
moveElAzSk_start_degrees($DishAngle);
$scan_rslt = waitMotorsReady($threshold);
if ($dbg_file) {
fprintf($dbg_file, "-----scan_rslt=%d:\n",$scan_rslt);
}
if ($scan_rslt < 0) {
$xml_state = simplexml_load_file($motosat_url);
if ($dbg_file) {
$DishAngle = explode(",",$xml_state->DishAngle);
foreach ($DishAngle as $key => $value){
$DishAngle[$key] = floatval($value);
}
fprintf($dbg_file, "\nDishAngle - after hitting/stopped:\n");
fprintf($dbg_file, print_r($DishAngle,1));
}
//,$LATE_STOP_AZ
//move az back to compensate for late stop
$DishCount = explode(",",$xml_state->DishCount);
foreach ($DishCount as $key => $value){
$DishCount[$key] = $value + 0;
}
if ($pass & 1){
$DishCount[0] += $LATE_STOP_AZ;
} else {
$DishCount[0] -= $LATE_STOP_AZ;
}
moveElAzSk_counts($DishCount);
if ($dbg_file) {
$xml_state = simplexml_load_file($motosat_url);
$DishAngle = explode(",",$xml_state->DishAngle);
foreach ($DishAngle as $key => $value){
$DishAngle[$key] = floatval($value);
}
fprintf($dbg_file, "\nDishAngle - after backing:\n");
fprintf($dbg_file, print_r($DishAngle,1));
}
$xml_state->addChild ('Success',(string) true );
return $xml_state;
}
$pass ++;
}
moveElAzSk_degrees($DishAngleCenter);
// while (true) {
// $counts = moveElAzSk_degrees($DishAngleCenter);
// if (!isset($counts)) break;
// }
while (null !==moveElAzSk_degrees($DishAngleCenter));
$xml_state = simplexml_load_file($motosat_url);
$xml_state->addChild ('Success',(string) false );
return $xml_state;
......@@ -320,7 +390,7 @@ function getModemStrength(){ //0.2sec
}
function moveElAzSk_start_counts($new_azelsk_count) {
global $motosat_url, $AZ_CMAX, $EL_CMAX, $SK_CMAX,$dbg,$dbg_file;
global $motosat_url, $AZ_CMAX, $EL_CMAX, $SK_CMAX,$OVERSHOOT,$dbg,$dbg_file;
$xml_state = simplexml_load_file($motosat_url);
$DishCount = explode(",",$xml_state->DishCount);
foreach ($DishCount as $key => $value){
......@@ -337,6 +407,9 @@ function moveElAzSk_start_counts($new_azelsk_count) {
$dist_el = $new_azelsk_count[1] - $DishCount[1];
$dist_sk = $new_azelsk_count[2] - $DishCount[2];
$dist_az = $new_azelsk_count[0] - $DishCount[0];
if (abs ($dist_el) <= $OVERSHOOT) $dist_el = 0;
if (abs ($dist_sk) <= $OVERSHOOT) $dist_sk = 0;
if (abs ($dist_az) <= $OVERSHOOT) $dist_az = 0;
$dir = "Up";
$dist = 0;
......@@ -430,10 +503,10 @@ function moveElAzSk_start_degrees($new_azelsk_degree) {
* Wait motors stopped and optionally modem strength > threshold
* Can be improved slightly by curl-multi: reading modem - 0.2s, controller - 0.29s
* @param $modem_threshold - if >0, stop on modem strength above threshold
* @return: 0: no ovement needed, >0 - number of status requests, <0 - -SignalQuality
* @return: 0: no movement needed, >0 - number of status requests, <0 - -SignalQuality
*/
function waitMotorsReady($modem_threshold = 0.0){ //
global $motosat_url;
global $motosat_url,$dbg_file;
$busy = true;
$try = 0;
while ($busy) {
......@@ -441,12 +514,43 @@ function waitMotorsReady($modem_threshold = 0.0){ //
$State = $xml_state->State+0; // 1 - Ready, 2 - Busy
$busy = ($State & 2) != 0;
if ($modem_threshold > 0){
$SignalQuality = (explode(",",myfval($xml_state->SignalQuality)[0]));
$SignalQuality = myfval(explode(",",$xml_state->SignalQuality)[0]);
if ($SignalQuality > $modem_threshold) {
$url = $motosat_url."?Action=Stop&Distance=0&Units=0";
$xml_state = simplexml_load_file($url);
$xml_state1 = simplexml_load_file($url);
if ($dbg_file) {
fprintf($dbg_file, "SignalQuality= %f:\n",$SignalQuality);
}
while ($busy) {
$xml_state1 = simplexml_load_file($motosat_url);
$State = $xml_state1->State+0; // 1 - Ready, 2 - Busy
$busy = ($State & 2) != 0;
if ($dbg_file) {
fprintf($dbg_file,$busy);
fprintf($dbg_file, " %03d State= %d:\n",$try,$State);
}
}
// Now move back to where good signal strength was detected
$DishCountGood = explode(",",$xml_state->DishCount);
foreach ($DishCountGood as $key => $value){
$DishCountGood[$key] = $value + 0;
}
moveElAzSk_counts($DishCountGood);
if ($dbg_file) {
fprintf($dbg_file, "SignalQuality= %f:\n",$SignalQuality);
}
return -$SignalQuality;
}
}
$try++;
if ($dbg_file) {
fprintf($dbg_file, "%03d State= %d:\n",$try,$State);
}
//?Action=Stop&Distance=0&Units=0
}
return $try;
......@@ -482,17 +586,4 @@ function myfval ($s) {
}
/*
$AZ_CPD = 12.74445;
$EL_CPD = 75.778567;
$SK_CPD = 8.34;
$AZ_0 = 0.0; // degrees
$EL_0 = 0.0; // degrees
$SK_0 = 55.7554; // degrees
$AZ_CMAX = 4790;
$EL_CMAX = 10979;
$SK_CMAX = 931;
*/
?>
\ No newline at end of file
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