Advertisement
tristanStrange

Untitled

Apr 15th, 2013
58
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.47 KB | None | 0 0
  1. // SUBSUMPTION - sum up amplified contributions
  2. task subsumption() {
  3.     while(true) {
  4.         lTotalMotorAct =
  5.                 (((lWanderMotorContrib * wanderAmp)
  6.             + lSeekMotorContrib) * seekAmp)
  7.             + lAvoidMotorContrib;
  8.  
  9.         rTotalMotorAct =
  10.             (((rWanderMotorContrib * wanderAmp)
  11.             + rSeekMotorContrib) * seekAmp)
  12.             + rAvoidMotorContrib;
  13.  
  14.         DriveLeftMotor((int)(lTotalMotorAct * MOTOR_MAX));
  15.         DriveRightMotor((int)(rTotalMotorAct * MOTOR_MAX));
  16.  
  17.         EndTimeSlice();
  18.     }
  19. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement