File indexing completed on 2024-04-14 14:10:54

 /*
     SPDX-FileCopyrightText: 2012 Jasem Mutlaq <mutlaqja@ikarustech.com>
 
     SPDX-License-Identifier: GPL-2.0-or-later
 */
 
 #include <basedevice.h>
 #include "indifocuser.h"
 #include "clientmanager.h"
 
 namespace ISD
 {
 
 void Focuser::registerProperty(INDI::Property prop)
 {
     if (!prop.getRegistered())
         return;
 
     if (prop.isNameMatch("FOCUS_MAX"))
     {
         auto nvp = prop.getNumber();
         m_maxPosition = nvp->at(0)->getValue();
     }
 
     ConcreteDevice::registerProperty(prop);
 }
 
 void Focuser::processNumber(INDI::Property prop)
 {
     auto nvp = prop.getNumber();
     if (prop.isNameMatch("FOCUS_MAX"))
     {
         m_maxPosition = nvp->at(0)->getValue();
     }
 }
 
 bool Focuser::focusIn()
 {
     auto focusProp = getSwitch("FOCUS_MOTION");
 
     if (!focusProp)
         return false;
 
     auto inFocus = focusProp->findWidgetByName("FOCUS_INWARD");
 
     if (!inFocus)
         return false;
 
     if (inFocus->getState() == ISS_ON)
         return true;
 
     focusProp->reset();
     inFocus->setState(ISS_ON);
 
     sendNewProperty(focusProp);
 
     return true;
 }
 
 bool Focuser::stop()
 {
     auto focusStop = getSwitch("FOCUS_ABORT_MOTION");
 
     if (!focusStop)
         return false;
 
     focusStop->at(0)->setState(ISS_ON);
     sendNewProperty(focusStop);
 
     return true;
 }
 
 bool Focuser::focusOut()
 {
     auto focusProp = getSwitch("FOCUS_MOTION");
 
     if (!focusProp)
         return false;
 
     auto outFocus = focusProp->findWidgetByName("FOCUS_OUTWARD");
 
     if (!outFocus)
         return false;
 
     if (outFocus->getState() == ISS_ON)
         return true;
 
     focusProp->reset();
     outFocus->setState(ISS_ON);
 
     sendNewProperty(focusProp);
 
     return true;
 }
 
 bool Focuser::getFocusDirection(ISD::Focuser::FocusDirection *dir)
 {
     auto focusProp = getSwitch("FOCUS_MOTION");
 
     if (!focusProp)
         return false;
 
     auto inFocus = focusProp->findWidgetByName("FOCUS_INWARD");
 
     if (!inFocus)
         return false;
 
     if (inFocus->getState() == ISS_ON)
         *dir = FOCUS_INWARD;
     else
         *dir = FOCUS_OUTWARD;
 
     return true;
 }
 
 bool Focuser::moveByTimer(int msecs)
 {
     auto focusProp = getNumber("FOCUS_TIMER");
 
     if (!focusProp)
         return false;
 
     focusProp->at(0)->setValue(msecs);
 
     sendNewProperty(focusProp);
 
     return true;
 }
 
 bool Focuser::moveAbs(int steps)
 {
     auto focusProp = getNumber("ABS_FOCUS_POSITION");
 
     if (!focusProp)
         return false;
 
     focusProp->at(0)->setValue(steps);
 
     sendNewProperty(focusProp);
 
     return true;
 }
 
 bool Focuser::canAbsMove()
 {
     auto focusProp = getNumber("ABS_FOCUS_POSITION");
 
     if (!focusProp)
         return false;
     else
         return true;
 }
 
 bool Focuser::moveRel(int steps)
 {
     INDI::PropertyView<INumber> *focusProp;
 
     if(canManualFocusDriveMove())
     {
         focusProp = getNumber("manualfocusdrive");
 
         FocusDirection dir;
         if (!getFocusDirection(&dir))
             return false;
         if (dir == FOCUS_INWARD)
             steps = -abs(steps);
         else if (dir == FOCUS_OUTWARD)
             steps = abs(steps);
 
         //manualfocusdrive needs different steps value ​​at every turn
         if (steps == getLastManualFocusDriveValue())
             steps += 1;
 
         //Nikon Z6 fails if step is -1, 0, 1
         if (deviation == NIKONZ6)
         {
             if (abs(steps) < 2)
                 steps = 2;
         }
     }
     else
     {
         focusProp = getNumber("REL_FOCUS_POSITION");
     }
 
     if (!focusProp)
         return false;
 
     focusProp->at(0)->setValue(steps);
 
     sendNewProperty(focusProp);
 
     return true;
 }
 
 bool Focuser::canRelMove()
 {
     auto focusProp = getNumber("REL_FOCUS_POSITION");
 
     if (!focusProp)
         return false;
     else
         return true;
 }
 
 bool Focuser::canManualFocusDriveMove()
 {
     auto focusProp = getNumber("manualfocusdrive");
 
     if (!focusProp)
         return false;
     else
         return true;
 }
 
 double Focuser::getLastManualFocusDriveValue()
 {
     auto focusProp = getNumber("manualfocusdrive");
 
     if (!focusProp)
         return 0;
 
     return focusProp->at(0)->getValue();
 }
 
 
 bool Focuser::canTimerMove()
 {
     auto focusProp = getNumber("FOCUS_TIMER");
 
     if (!focusProp)
         return false;
     else
         return true;
 }
 
 bool Focuser::setMaxPosition(uint32_t steps)
 {
     auto focusProp = getNumber("FOCUS_MAX");
 
     if (!focusProp)
         return false;
 
     focusProp->at(0)->setValue(steps);
     sendNewProperty(focusProp);
 
     return true;
 }
 
 bool Focuser::hasBacklash()
 {
     auto focusProp = getNumber("FOCUS_BACKLASH_STEPS");
     return (focusProp != nullptr);
 }
 
 bool Focuser::setBacklash(int32_t steps)
 {
     auto focusToggle = getSwitch("FOCUS_BACKLASH_TOGGLE");
     if (!focusToggle)
         return false;
 
     // Make sure focus compensation is enabled.
     if (steps != 0 && focusToggle->at(0)->getState() != ISS_ON)
     {
         focusToggle->reset();
         focusToggle->at(0)->setState(ISS_ON);
         focusToggle->at(1)->setState(ISS_OFF);
         sendNewProperty(focusToggle);
     }
 
     auto focusProp = getNumber("FOCUS_BACKLASH_STEPS");
     if (!focusProp)
         return false;
 
     focusProp->at(0)->setValue(steps);
     sendNewProperty(focusProp);
 
     // If steps = 0, disable compensation
     if (steps == 0 && focusToggle->at(0)->getState() == ISS_ON)
     {
         focusToggle->reset();
         focusToggle->at(0)->setState(ISS_OFF);
         focusToggle->at(1)->setState(ISS_ON);
         sendNewProperty(focusToggle);
     }
     return true;
 }
 
 int32_t Focuser::getBacklash()
 {
     auto focusProp = getNumber("FOCUS_BACKLASH_STEPS");
     if (!focusProp)
         return -1;
 
     return focusProp->at(0)->getValue();
 }
 
 bool Focuser::hasDeviation()
 {
     if (getDeviceName() == "Nikon DSLR Z6")
     {
         deviation = NIKONZ6;
         return true;
     }
     return false;
 }
 
 }