Changeset 9439 for trunk/MagicSoft/Cosy/main/MStarguider.cc

Timestamp:

05/09/09 13:48:12 (16 years ago)

Author:

tbretz

Message:

*** empty log message ***

File:

• trunk/MagicSoft/Cosy/main/MStarguider.cc (modified) (52 diffs)

trunk/MagicSoft/Cosy/main/MStarguider.cc

@@ -1 @@
-#undef EXPERT
 #undef EXPERT
 
@@ -307 +306 @@
 
     fGStarg = new MGStarg(this, 235);
-    fGStarg->DrawText("0.75'", "1.50'", "3.00'", "Mispointing [min]");
-    fGStarg->DrawHexagon();
     fGStarg->Move(530,596+5);
     fList->Add(fGStarg);
@@ -342 +339 @@
 
     fTPoint = new TGTextButton(this, "TPoint");
-    fTPoint->Move(4, fMenu->GetDefaultHeight()+785);
+    //fTPoint->Move(4, fMenu->GetDefaultHeight()+785);
+    fTPoint->Move(170, fMenu->GetDefaultHeight()+785);
     fTPoint->AllowStayDown(kTRUE);
     AddFrame(fTPoint);
-
-    fStargTPoint = new TGTextButton(this, "StargTPoint");
-    fStargTPoint->Move(170, fMenu->GetDefaultHeight()+785);
-    fStargTPoint->AllowStayDown(kTRUE);
-    AddFrame(fStargTPoint);
+    /*
+     fStargTPoint = new TGTextButton(this, "StargTPoint");
+     fStargTPoint->Move(170, fMenu->GetDefaultHeight()+785);
+     fStargTPoint->AllowStayDown(kTRUE);
+     AddFrame(fStargTPoint);
+    */
 
     fFps = new TGLabel(this, "---fps");
@@ -448 +447 @@
     MapSubwindows();
     fTPoint->UnmapWindow();
-    fStargTPoint->UnmapWindow();
+    //fStargTPoint->UnmapWindow();
     fGStarg->UnmapWindow();
     fGNumStars->UnmapWindow();
@@ -479 +478 @@
       fOutTp(0),
       fOutStargTp(0),
-      fOutRq(0),
+//      fOutRq(0),
       fDx((768-kZOOM)/2),
       fDy((512-kZOOM)/2),
       fStatus(MDriveCom::kStandby),
       fRadius(200),
-      fTPointFromCC(0)
+      fTPointFromCC(-1),
+      fFindStarCut(3.0), fFindStarBox(70)
 {
     gLog << warn << " #### FIXME: Make MCaos Thread safe!" << endl;
@@ -557 +557 @@
 
     fRadius = env.GetValue("Leds.Radius", fRadius);
+
+    fStarguiderW = env.GetValue("Starguider.Width",  fStarguiderW);
+    fStarguiderH = env.GetValue("Starguider.Height", fStarguiderH);
+    fStarguiderX = env.GetValue("Starguider.X",      fStarguiderX);
+    fStarguiderY = env.GetValue("Starguider.Y",      fStarguiderY);
+
+    fSkyOffsetX = env.GetValue("Starguider.SkyOffsetX", fSkyOffsetX);
+    fSkyOffsetY = env.GetValue("Starguider.SkyOffsetY", fSkyOffsetY);
+
+    fFindStarBox = env.GetValue("FindStar.SizeBox",       fFindStarBox);
+    fFindStarCut = env.GetValue("FindStar.CleaningLevel", fFindStarCut);
 }
 
@@ -583 +594 @@
         delete fOutStargTp;
 
-    if (fOutRq)
-        delete fOutRq;
+//    if (fOutRq)
+//        delete fOutRq;
 
     gLog << inf2 << "Camera Display destroyed." << endl;
@@ -649 +660 @@
 }
 
+/*
 void MStarguider::ToggleFindStar()
 {
     if (fDisplay->IsEntryChecked(IDM_kFindStar) && fCosy)
-        fTPoint->MapWindow();
+    fTPoint->MapWindow();
     else
     {
@@ -659 +671 @@
     }
 }
-
+*/
 void MStarguider::ToggleStarguider()
 {
@@ -671 +683 @@
         fOperations->EnableEntry(IDM_kStargAnalysis);
 
-        fStargTPoint->MapWindow();
+        //fStargTPoint->MapWindow();
 
         fPZdAz->MapWindow();
@@ -703 +715 @@
         SwitchOff(fChannel, IDM_kChannel2);
         fChannel->CheckEntry(IDM_kChannel1);
-
     }
     else
@@ -709 +720 @@
         fStatus = MDriveCom::kStandby;
 
-        fStargTPoint->UnmapWindow();
-        fStargTPoint->SetDown(kFALSE);
+        //fStargTPoint->UnmapWindow();
+        //fStargTPoint->SetDown(kFALSE);
 
         fPZdAz->UnmapWindow();
@@ -772 +783 @@
     MapSubwindows(); // maps everything, but we don't want that
     fTPoint->UnmapWindow();
-    fStargTPoint->UnmapWindow();
+    //fStargTPoint->UnmapWindow();
     fGStarg->UnmapWindow();
     fGNumStars->UnmapWindow();
@@ -863 +874 @@
                     //tpoint
                     SwitchOff(fDisplay, IDM_kFindStar);
-                    ToggleFindStar();
                     SwitchOff(fDisplay, IDM_kCaosFilter);
                     ToggleCaosFilter();
@@ -874 +884 @@
 
                     //check needed items
-                    fDisplay->CheckEntry(IDM_kStretch);
+                    fDisplay->UnCheckEntry(IDM_kStretch);
                     fDisplay->CheckEntry(IDM_kStargCaosFilter);
                     fDisplay->CheckEntry(IDM_kStarguider);
                     ToggleStarguider();
+
+                    fTPoint->MapWindow();
                 }
                 else
@@ -885 +897 @@
                     fDisplay->UnCheckEntry(IDM_kStargCaosFilter);
                     fDisplay->UnCheckEntry(IDM_kStarguider);
+                    fTPoint->UnmapWindow();
                     ToggleStarguider();
 
@@ -922 +935 @@
 
                     //checking needed items
-                    fDisplay->CheckEntry(IDM_kStretch);
+                    fDisplay->UnCheckEntry(IDM_kStretch);
                     fDisplay->CheckEntry(IDM_kCaosFilter);
                     ToggleCaosFilter();
                     fDisplay->CheckEntry(IDM_kFindStar);
-                    ToggleFindStar();
+                    fTPoint->MapWindow();
                 }
                 else
@@ -946 +959 @@
                     ToggleCaosFilter();
                     fDisplay->UnCheckEntry(IDM_kFindStar);
-                    ToggleFindStar();
+                    fTPoint->UnmapWindow();
                 }
                 return kTRUE;
@@ -956 +969 @@
             case IDM_kFindStar:
                 Toggle(fDisplay, IDM_kFindStar);
-                ToggleFindStar();
+                //ToggleFindStar();
                 return kTRUE;
 
@@ -1293 +1306 @@
 #endif
 
+    return fSao->CalcDeltaZdAzFromPix(mx, my)*TMath::RadToDeg();
+/*
     AltAz pos0 = fSao->CalcAltAzFromPix(768/2,    576/2)*kRad2Deg;
     AltAz pos1 = fSao->CalcAltAzFromPix(768/2+mx, 576/2+my)*kRad2Deg;
@@ -1298 +1313 @@
     pos1 -= pos0;
 
-    return ZdAz(-pos1.Alt(), pos1.Az());
-}
-
-Int_t MStarguider::CalcTrackingError(Leds &leds, MStarList &stars,
-                                     ZdAz &d, MTime &t, double &bright, Int_t &num)
-{
+    ZdAz res2 = ZdAz(-pos1.Alt(), pos1.Az());
+
+    return res1;
+*/
+}
+
+Int_t MStarguider::CalcTrackingError(const Leds &leds, MStarList &stars,
+                                     ZdAz &d, const MTime &t, const double &bright,
+                                     Int_t &num, const Ring &center, Int_t numleds, Int_t numrings)
+{
+    // Get tracking coordinates
+    const XY xy = fCRaDec->GetCoordinates();
+
     num = leds.GetEntries();
     if (num < 3) //was 1
     {
         gLog << warn << "Sorry, less than 3 detected spot in FOV!" << endl;
-        fStargTPoint->SetDown(kFALSE);
+        if (fTPoint->IsDown() && fCosy && fCosy->GetDriveCom())
+            fCosy->GetDriveCom()->SendTPoint(false, 'S', fTPointStarMag, fTPointStarName, AltAz(), ZdAz(), xy, 0, 0, t, center, Led(), numleds, numrings, num);    // Report
+        fTPoint->SetDown(kFALSE);
         return 0;
     }
@@ -1315 +1339 @@
     {
         gLog << warn << "Sorry, less than 3 stars in FOV!" << endl;
-        fStargTPoint->SetDown(kFALSE);
+        if (fTPoint->IsDown() && fCosy && fCosy->GetDriveCom())
+            fCosy->GetDriveCom()->SendTPoint(false, 'S', fTPointStarMag, fTPointStarName, AltAz(), ZdAz(), xy, 0, 0, t, center, Led(), numleds, numrings, num);    // Report
+        fTPoint->SetDown(kFALSE);
         return 0;
     }
@@ -1375 +1401 @@
     if (numcor<1)
     {
-        fStargTPoint->SetDown(kFALSE);
+        fTPoint->SetDown(kFALSE);
+        if (fTPoint->IsDown() && fCosy && fCosy->GetDriveCom())
+            fCosy->GetDriveCom()->SendTPoint(false, 'S', fTPointStarMag, fTPointStarName, AltAz(), ZdAz(), xy, 0, 0, t, center, Led(), numleds, numrings, num, numcor);    // Report
         return 0;
     }
@@ -1388 +1416 @@
 
     // Check StargTPoint data set request
-    if (!fStargTPoint->IsDown())
+    if (!fDisplay->IsEntryChecked(IDM_kStarguiderMode) || !fTPoint->IsDown())
         return numcor;
-    fStargTPoint->SetDown(kFALSE);
+    fTPoint->SetDown(kFALSE);
 
     // If no file open: open new file
@@ -1406 +1434 @@
     }
 
-    // Get tracking coordinates
-    const XY    xy = fCRaDec->GetCoordinates();
     const RaDec rd(xy.X()*MAstro::HorToRad(), xy.Y()*TMath::DegToRad());
 
@@ -1430 +1456 @@
 
     // Write real pointing position
-    //cout << "     Alt/Az: " << za0.Alt() << "° " << za0.Az() << "°" << endl;
     *fOutStargTp << setprecision(7) << za0.Az() << " " << za0.Alt() << " ";
 
     // Write system pointing position
-    //cout << "     SE-Pos: " << 90-cpos.Zd() << "° " << cpos.Az() << "°" << endl;
     *fOutStargTp << fmod(cpos.Az()+360, 360) << " " << 90-cpos.Zd();
 
@@ -1440 +1464 @@
     *fOutStargTp << " " << d.Zd() << " " << d.Az();
     *fOutStargTp << " " << setprecision(11) << t.GetMjd();
-    *fOutStargTp << " " << num;
-    *fOutStargTp << " " << bright;
+    *fOutStargTp << " " << setprecision(4) << center.GetMag();
+    *fOutStargTp << " " << star->GetMag();
+    *fOutStargTp << " " << center.GetX() << " " << center.GetY();
+    *fOutStargTp << " 0 0";
+    *fOutStargTp << " " << numleds << " " << numrings;
+    *fOutStargTp << " " << num << " " << numcor << " " << bright;
     *fOutStargTp << endl;
 
+    gLog << all << "Starguider TPoint successfully taken." << endl;
+
     fTimeFromTp.Clear();
 
+    if (!fCosy)
+        return numcor;
+
+    MDriveCom *com = fCosy->GetDriveCom();
+    if (!com)
+        return numcor;
+
+    com->SendTPoint(true, 'S', fTPointStarMag, fTPointStarName, za0, cpos, xy, d.Zd(), d.Az(), t, center, Led(), numleds, numrings, num, numcor);    // Report
+
     return numcor;
 }
 
-void MStarguider::FindStar(FilterLed &f, FilterLed &f2, Ring &center, MTime &t)
-{
+void MStarguider::FindStar(const FilterLed &f, const FilterLed &f2, const Ring &center, const MTime &t, Int_t numleds, Int_t numrings)
+{
+    // Get tracking coordinates
+    const XY xy = fCRaDec->GetCoordinates();  // [h, deg]
+
+    if (center.GetX()<=0 && center.GetY()<=0)
+    {
+        gLog << warn << "Couldn't determine center of the camera." << endl;
+        if (fTPoint->IsDown() && fCosy && fCosy->GetDriveCom())
+            fCosy->GetDriveCom()->SendTPoint(false, 'T', fTPointStarMag, fTPointStarName, AltAz(), ZdAz(), xy, 0, 0, t, center, Led(), numleds, numrings);    // Report
+        return;
+    }
+
     // Try to find the star
     Leds leds;
@@ -1459 +1509 @@
     if (!star)
     {
-        if (fTPoint->IsDown())
-        {
-            fTPoint->SetDown(kFALSE);
-            gLog << warn << "No star found. Couldn't take a tpoint." << endl;
-        }
+        gLog << warn << "No star found." << endl;
+        if (fTPoint->IsDown() && fCosy && fCosy->GetDriveCom())
+            fCosy->GetDriveCom()->SendTPoint(false, 'T', fTPointStarMag, fTPointStarName, AltAz(), ZdAz(), xy, 0, 0, t, center, Led(), numleds, numrings);    // Report
         return;
     }
@@ -1470 +1518 @@
     star->Print();
     f2.MarkPoint(star->GetX(), star->GetY(), 2<<2);
+
+    const RaDec rd(xy.X()*MAstro::HorToRad(), xy.Y()*TMath::DegToRad());
 
     // Initialize Star Catalog on the camera plane
@@ -1478 +1528 @@
     ac.SetObservatory(*fSao);
     ac.SetTime(t);
-
-    // Get tracking coordinates
-    const XY xy = fCRaDec->GetCoordinates();  // [h, deg]
-    const RaDec rd(xy.X()*MAstro::HorToRad(), xy.Y()*TMath::DegToRad());
-
     ac.SetRaDec(rd.Ra(), rd.Dec());
 
@@ -1500 +1545 @@
 
     // Check TPoint data set request
-    if (!fTPoint->IsDown())
+    if (!fDisplay->IsEntryChecked(IDM_kTpointMode) || !fTPoint->IsDown())
         return;
-
-    fTPoint->SetDown(kFALSE);
 
     // If no file open: open new file
@@ -1539 +1582 @@
     const ZdAz za1 = fCosy->GetSePos()*360; // [deg]
 
+
     // Write real pointing position
     //cout << "     Alt/Az: " << za0.Alt() << "° " << za0.Az() << "°" << endl;
@@ -1552 +1596 @@
     *fOutTp << " " << setprecision(4) << center.GetMag();
     *fOutTp << " " << star->GetMag();
+    *fOutTp << " " << center.GetX() << " " << center.GetY();
+    *fOutTp << " " << star->GetX() << " " << star->GetY();
+    *fOutTp << " " << numleds << " " << numrings;
+    *fOutTp << " 0 0 0";
     *fOutTp << endl;
+
+    gLog << all << "TPoint successfully taken." << endl;
 /*
     MLog &outrep = *fCosy->GetOutRep();
@@ -1570 +1620 @@
     
 //    return zdaz;
+
+    if (!fCosy)
+        return;
+
+    MDriveCom *com = fCosy->GetDriveCom();
+    if (!com)
+        return;
+
+    com->SendTPoint(true, 'T', fTPointStarMag, fTPointStarName, za0, za1, xy, -dzd, -daz, t, center, *star, numleds, numrings);    // Report
 }
 
@@ -1624 +1683 @@
 }
 
-void MStarguider::StartStarguider()
+void MStarguider::StartTPoint(char *cmd)
+{
+    fTPointStarName = "Dummy";
+    fTPointStarMag  = 0;
+
+    TString str(cmd);
+
+    TObjArray *arr = str.Tokenize(' ');
+
+    if (arr->GetEntries()==2)
+    {
+        fTPointStarName = (*arr)[0]->GetName();
+        fTPointStarMag  = atof((*arr)[1]->GetName());
+    }
+
+    delete arr;
+
+    if (fTPointFromCC<0)
+        fTPointFromCC=0;
+}
+
+void MStarguider::StartStarguider(bool on)
 {
     // Switch to starguider mode
-    cout << " * Switching to Starguider mode" << endl;
-    fMode->UnCheckEntry(IDM_kStarguiderMode);
-    ProcessMessage(MK_MSG(kC_COMMAND, kCM_MENU), IDM_kStarguiderMode, 0);
+    if (on)
+    {
+        cout << " * Switching Starguider mode on" << endl;
+        fMode->UnCheckEntry(IDM_kStarguiderMode);
+        ProcessMessage(MK_MSG(kC_COMMAND, kCM_MENU), IDM_kStarguiderMode, 0);
+    }
+    else
+    {
+        cout << " * Switching Starguider mode off" << endl;
+        fMode->CheckEntry(IDM_kStarguiderMode);
+        ProcessMessage(MK_MSG(kC_COMMAND, kCM_MENU), IDM_kStarguiderMode, 0);
+    }
+}
+
+Int_t MStarguider::GetStarguiderMode() const
+{
+    return fMode->IsEntryChecked(IDM_kStarguiderMode) ? 1 : 2;
+
 }
 
 Bool_t MStarguider::DoTPoint()
 {
+    if (fTPoint->IsDown() && fTPointFromCC<0)
+    {
+        fTPointFromCC = 0;
+        fTPoint->SetDown(kFALSE);
+    }
+
     if (fTPointFromCC<0)
         return kTRUE;
@@ -1650 +1751 @@
 
     case 2:
+    case 3:
         cout << " * Waiting one frame" << endl;
         // Wait one frame
         return kFALSE;
 
-    case 3:
+    case 4:
         cout << " * Taking TPoint" << endl;
         fTPoint->SetDown(); // kTRUE
         return kTRUE;
 
-    case 4:
+    case 5:
         if (!fTimeFromTp) // TPoint failed
             break;
@@ -1669 +1771 @@
         return kFALSE;
 
-    case 5:
+    case 6:
+    case 7:
         cout << " * Waiting one frame" << endl;
         // Wait one frame
         return kFALSE;
 
-    case 6:
+    case 8:
         cout << " * Taking Starguider TPoint" << endl;
-        fStargTPoint->SetDown(); // kTRUE
+        fTPoint->SetDown(); // kTRUE
         return kTRUE;
 
-    case 7:
-        cout << " * Send Report" << endl;
+//    case 9:
+//        cout << " * Send Report" << endl;
+//        return kTRUE;
+
+    case 9:
+        cout << " * Switching to TPoint mode" << endl;
+        // Switch to tpoint mode
+        fMode->UnCheckEntry(IDM_kTpointMode);
+        ProcessMessage(MK_MSG(kC_COMMAND, kCM_MENU), IDM_kTpointMode, 0);
         break;
     }
@@ -1686 +1796 @@
     // Send report
     fTPointFromCC = -1;
-
+/*
     if (!fCosy)
         return kTRUE;
@@ -1702 +1812 @@
     //fNumStarsCorrelated = rc;
     com->SendTPoint(fNumStarsCorrelated>0);
-
+*/
     return kTRUE;
 }
@@ -1736 +1846 @@
     if (!fWritePictures->IsEntryEnabled(IDM_kStart) &&
         (!(n%fWrtRate) || fWriteType->IsEntryChecked(IDM_kOnce)))
-    {     
+    {
 
         if (fFileType->IsEntryChecked(IDM_kPNG))
@@ -1752 +1862 @@
         f.Execute();
 
-    DoTPoint();
+    if (!DoTPoint())
+        return;
 
     Int_t numleds = 0;
@@ -1758 +1869 @@
 
     // Find Center of Camera for Caos and Tpoints
-    Ring center(768/2, 576/2);
+//    Ring center;//(-1, -1);
+    Ring center(5, 5);//(-1, -1);
     if (fDisplay->IsEntryChecked(IDM_kCaosFilter))
     {
@@ -1774 +1886 @@
 
     // Find Star at Center---for Tpoint Procedure
-    if (fDisplay->IsEntryChecked(IDM_kFindStar) &&
-        center.GetX()>0 && center.GetY()>0)
+    if (fDisplay->IsEntryChecked(IDM_kFindStar))
     {
         // Set search Paremeters (FIXME: Get them from user input!)
-        f.SetCut(3.0);
-        f.SetBox(70);
-
-        FindStar(f, f2, center, t);
+        f.SetCut(fFindStarCut);
+        f.SetBox(fFindStarBox);
+
+        FindStar(f, f2, center, t, numleds, numrings);
     }
 
@@ -1788 +1899 @@
 
     // Position corresponding to the camera center (53.2, 293.6)
-    Ring sgcenter(53.2, 293.6); // Center of camera in SG picture [px]
+    Ring sgcenter;//(-1, -1); // Center of camera in SG picture [px]
 
     // Find Center of Camera in Starfield Camera picture 
@@ -1817 +1928 @@
         fCZdAz->SetCoordinates(fSao->GetZdAz());
 
-        fSao->SetBox(230); // Region of interest around center
+        fSao->SetBox(fStarguiderW, fStarguiderH); // 280 Region of interest around center
 
         // If center of camera cannot be determined sgcenter is (0,0)
         const Bool_t centerisvalid = sgcenter.GetX()>0 && sgcenter.GetY()>0;
-//        if (centerisvalid)
-//            skycenter.SetXY(sgcenter.GetX() -  53.2,
-//                            sgcenter.GetY() - 293.6);
 
         // We determine the ideal starfield using camera sagging info
@@ -1830 +1938 @@
         // 53.2 and 293.6 are the "preliminary" camera center
         // -9 and 28.5 are the offsets of the pointing position in the sky
-        const XY off(sgcenter.GetX()- 53.2-9,
-                     sgcenter.GetY()-293.6+28.5);
-
-        // we obtain stars in the effective star FOV and draw them.
-        // coordinates are video frame coords.
-        MStarList stars;
-        fSao->CalcStars(stars, 530, 292, TMath::FloorNint(off.X()), TMath::FloorNint(off.Y()));
-        fSao->DrawStars(stars, cimg);
-
-        // Position around which the circles are drawn.
-        const Ring skycenter(768/2-off.X(), 576/2+off.Y());
+        //const XY off(sgcenter.GetX()- 53.2-9,
+        //             sgcenter.GetY()-293.6+28.5);
+
+        // Skycenter
+        const XY off(sgcenter.GetX() + fSkyOffsetX,
+                     sgcenter.GetY() + fSkyOffsetY);
+
+        MStarList stars;
+        if (centerisvalid)
+        {
+            // we obtain stars in the effective star FOV and draw them.
+            // coordinates are video frame coords.
+            fSao->CalcStars(stars, fStarguiderX, fStarguiderY, off.X(), off.Y());
+            fSao->DrawStars(stars, cimg);
+        }
 
         // There are two corrections to the mispointing
@@ -1853 +1965 @@
 
             Leds spots;
-            f.SetBox(230);
+            f.SetBox(fStarguiderW, fStarguiderH); // 280
             f.SetCut(cut);
 
             double bright;
-            f.ExecuteAndMark(spots, 530, 292, bright);
+            f.ExecuteAndMark(spots, fStarguiderX, fStarguiderY, bright);
 
             ULong_t color;
@@ -1878 +1990 @@
 
             Int_t numstars = 0;
-            const Int_t rc = CalcTrackingError(spots, stars, fD, t, bright, numstars);
+            const Int_t rc = CalcTrackingError(spots, stars, fD, t, bright, numstars, sgcenter, numleds, numrings);
 
             const Bool_t monitoring = brightnessisvalid && centerisvalid && fNumStarsCorrelated>2;
@@ -1907 +2019 @@
         if (centerisvalid && fNumStarsCorrelated>2)
         {
+            // Position around which the circles are drawn.
+            const Ring skycenter(off.X(), off.Y());
+
             f2.DrawCircle(skycenter,   2.0,     0x0a);
 
@@ -1917 +2032 @@
 
     } //CalcStars
+
+    if (fTPoint->IsDown())
+        fTPoint->SetDown(kFALSE);
 
     // Draw Circles around center of Camera
@@ -1948 +2066 @@
 void MStarguider::UpdatePosZoom()
 {
-    MString txt;
+    MString txt;/*
     if (fDisplay->IsEntryChecked(IDM_kCatalog))
     {
@@ -1958 +2076 @@
         txt.Form("(%d, %d) %.1fd/%.1fd", fDx, fDy, -aa.Alt(), aa.Az()-180);
     }
-    else
+    else*/
         txt.Form("(%d, %d)", fDx, fDy);
     fPosZoom->SetText(txt);