Advertisement
electrotwelve

Parse remote commands

Mar 20th, 2021
760
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 2.53 KB | None | 0 0
  1. void Parse_Pi_Motor_Commands(void)
  2. {
  3.     // M1
  4.     if ((M1.pi_state == 1) && (M1.endstop_status == UNTRIGGERED) && (M1.dir == CW) && (M1.runstate == STOPPED))
  5.     {
  6.         Start_M1_CW();
  7.     }
  8.     else if ((M1.pi_state == 1) && (M1.endstop_status == UNTRIGGERED) && (M1.dir == CCW) && (M1.runstate == STOPPED))
  9.     {
  10.         Start_M1_CCW();
  11.     }
  12.     else if (M1.pi_state == 0)
  13.     {
  14.         Stop_M1();
  15.     }
  16.  
  17.     // M2
  18.     if ((M2.pi_state == 1) && (M2.endstop_status == UNTRIGGERED) && (M2.dir == CW) && (M2.runstate == STOPPED))
  19.     {
  20.         Start_M2_CW();
  21.     }
  22.     else if ((M2.pi_state == 1) && (M2.endstop_status == UNTRIGGERED) && (M2.dir == CCW) && (M2.runstate == STOPPED))
  23.     {
  24.         Start_M2_CCW();
  25.     }
  26.     else if (M2.pi_state == 0)
  27.     {
  28.         Stop_M2();
  29.     }
  30.  
  31.     // M3
  32.     if ((M3.pi_state == 1) && (M3.endstop_status == UNTRIGGERED) && (M3.dir == CW) && (M3.runstate == STOPPED))
  33.     {
  34.         Start_M3_CW();
  35.     }
  36.     else if ((M3.pi_state == 1) && (M3.endstop_status == UNTRIGGERED) && (M3.dir == CCW) && (M3.runstate == STOPPED))
  37.     {
  38.         Start_M3_CCW();
  39.     }
  40.     else if (M3.pi_state == 0)
  41.     {
  42.         Stop_M3();
  43.     }
  44.  
  45.     // M4
  46.     if ((M4.pi_state == 1) && (M4.endstop_status == UNTRIGGERED) && (M5.endstop_status == UNTRIGGERED) && (M4.dir == CW)
  47.             && (M4.runstate == STOPPED) && (M5.runstate == STOPPED))
  48.     {
  49.         Start_M4_5_CW();
  50.     }
  51.     else if ((M4.pi_state == 1) && (M4.endstop_status == UNTRIGGERED) && (M5.endstop_status == UNTRIGGERED) && (M4.dir == CCW)
  52.             && (M4.runstate == STOPPED) && (M5.runstate == STOPPED))
  53.     {
  54.         Start_M4_5_CCW();
  55.     }
  56.     else if (M4.pi_state == 0)
  57.     {
  58.         Stop_M4_5();
  59.     }
  60.  
  61.     // A6
  62.     if ((A6.pi_state == 1) && (A6.endstop_status == UNTRIGGERED) && (A6.dir == CW) && (A6.runstate == STOPPED))
  63.     {
  64.         Start_A6_CW();
  65.     }
  66.     else if ((A6.pi_state == 1) && (A6.endstop_status == UNTRIGGERED) && (A6.dir == CCW) && (A6.runstate == STOPPED))
  67.     {
  68.         Start_A6_CCW();
  69.     }
  70.     else if (A6.pi_state == 0)
  71.     {
  72.         Stop_A6();
  73.     }
  74.  
  75.     // A7
  76.     if ((A7.pi_state == 1) && (A7.endstop_status == UNTRIGGERED) && (A7.dir == CW) && (A7.runstate == STOPPED))
  77.     {
  78.         Start_A7_CW();
  79.     }
  80.     else if ((A7.pi_state == 1) && (A7.endstop_status == UNTRIGGERED) && (A7.dir == CCW) && (A7.runstate == STOPPED))
  81.     {
  82.         Start_A7_CCW();
  83.     }
  84.     else if (A7.pi_state == 0)
  85.     {
  86.         Stop_A7();
  87.     }
  88.  
  89.     // STPR
  90.     if ((STPR.pi_state == 1) && (STPR.endstop_status == UNTRIGGERED) && (STPR.dir == CW) && (STPR.runstate == STOPPED))
  91.     {
  92.         Start_STPR_CW();
  93.     }
  94.     else if ((STPR.pi_state == 1) && (STPR.endstop_status == UNTRIGGERED) && (STPR.dir == CCW) && (STPR.runstate == STOPPED))
  95.     {
  96.         Start_STPR_CCW();
  97.     }
  98.     else if (STPR.pi_state == 0)
  99.     {
  100.         Stop_STPR();
  101.     }
  102. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement