 #include "stuPanTilt.h"
 #include "stuLaser.h"
 
+#define DIRECTION_CHANGE_PROBABILITY 15
+
+
 #define BAUD_RATE 115200
-#define DIRECTION_CHANGE_PROBABILITY 15
 
 
 //X Position: lower numbers == Right


panTiltPos_t panTiltX(0, 55, 125, -20);
panTiltPos_t panTiltY(0, 10, 45);

PanTilt panTilt(9, &panTiltX, 10, &panTiltY, 98);


  changeVal = getMarkovSpeed(changeVal);

  panTiltX.angle = getDeltaPosition(&panTiltX, changeVal, DIRECTION_CHANGE_PROBABILITY) + panTiltX.angle;



  panTiltY.angle = getDeltaPosition(&panTiltY, changeVal, DIRECTION_CHANGE_PROBABILITY) + panTiltY.angle;

