Advertisement
Guest User

Untitled

a guest
Mar 25th, 2019
105
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.89 KB | None | 0 0
  1. #pragma config(I2C_Usage, I2C1, i2cSensors)
  2. #pragma config(Sensor, dgtl9, upLmt, sensorTouch)
  3. #pragma config(Sensor, dgtl10, downLmt, sensorTouch)
  4. #pragma config(Sensor, dgtl11, dwnBttn, sensorTouch)
  5. #pragma config(Sensor, dgtl12, upBttn, sensorTouch)
  6. #pragma config(Sensor, I2C_1, rightIME, sensorQuadEncoderOnI2CPort, , AutoAssign )
  7. #pragma config(Sensor, I2C_2, leftIME, sensorNone)
  8. #pragma config(Sensor, I2C_3, armIME, sensorNone)
  9. #pragma config(Motor, port2, armMotor, tmotorVex393_MC29, openLoop, reversed, encoderPort, I2C_1)
  10.  
  11. task main()
  12. {
  13. //Loop Forever
  14. while(1 == 1)
  15. {
  16. if(SensorValue(upBttn)== 1 && SensorValue(upLmt)== 0)
  17. {
  18. motor[armMotor] = 40;
  19. }
  20. else if(SensorValue(dwnBttn)== 1 && SensorValue(downLmt)== 0)
  21. {
  22. motor[armMotor] = -40;
  23. }
  24. else
  25. {
  26. motor[armMotor] = 0;
  27. }
  28. }
  29. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement