// © RiceMotion ( Robert Carl Rice ) 2012-2016 - All rights reserved


// This software makes use of tools and libraries obtained from open source projects or released for

// use by relevant hardware manufactures. However, this software is NOT a part of any open source project.

// It is released only on a "need to know" basis for beta testers of the "RiceCNC Interpolation Engine".

// Recipents of this source code must respect the confidential nature of this software and prevent any

// distribution that could result in counterfeit copies of the "RiceCNC Interpolation Engine".


// © RiceMotion ( Robert Carl Rice ) 2012-2016 - All rights reserved

#include <Probe.h>

#include  <InputPin.h>



Probe::~Probe() {

     if ( pin )

          delete pin; };


Probe::Probe(

     char*          data,

     String*          msgPtr ) {


     analogAverage     = 0;


     transition          = (*data) == '+';


     pin          = new InputPin(

          data + 1,

          msgPtr );


     if ( pin->valid() ) {

          state          = debounce();


          *msgPtr          += " Probe input pin ";

          pin->fmtPin( msgPtr );


          if ( transition )

               *msgPtr    += " On transition"; }


     else {

          delete pin;

          pin    = NULL; }; };


bool

     Probe::isValid() {


     return

          pin          != NULL; };

     

bool

     Probe::probeStop() {


     bool priorState          = state;

     state               = debounce();

     return

          (     state

          &&     ( ! transition || ! priorState ) ); };


void

     Probe::reportDigital( String* msgPtr ) {


     pin->reportPinChange( msgPtr ); };


bool

     Probe::debounce() {

     

     analogAverage     -= analogAverage >> 8;

     if ( pin->readPin() )

          analogAverage     += 0x100;


     return

          analogAverage     >= 0x8000; };