Changeset 8862 for trunk/MagicSoft/Cosy/devdrv/shaftencoder.cc

Timestamp:

02/13/08 19:44:39 (17 years ago)

Author:

tbretz

Message:

*** empty log message ***

File:

• trunk/MagicSoft/Cosy/devdrv/shaftencoder.cc (modified) (2 diffs)

trunk/MagicSoft/Cosy/devdrv/shaftencoder.cc

@@ -278 +278 @@
     // Decode information, we have a 14bit only
     //
-    LWORDS_t pos = data[0] | (data[1]<<8) | (data[2]<<16); // | (data[3]<<24);
+    LWORDS_t pos = data[0] | (data[1]<<8) | (data[2]<<16) | (data[3]<<24);
 
     fVel = data[4] | (data[5]<<8);
@@ -465 +465 @@
         return;
 
-    fPos  = pre%16384;
-    fTurn = pre/16384;
+    fPos  = pre%fTicks;
+    fTurn = pre/fTicks;
     fDirChangedPos = fPos;
     fOffset = fMotor ? fMotor->GetPdoPos() : 0;