RoCoN: new command REGOUTMAP to setup power outputs connection to axes.

[fpga/lx-cpu1/lx-rocon.git] / sw / app / rocon / appl_pxmc.c

diff --git a/sw/app/rocon/appl_pxmc.c b/sw/app/rocon/appl_pxmc.c
index ec520dce6b422cba53830e2da86ffd00db342278..a7abedc1e86080da736250433f776388674a59d3 100644 (file)
--- a/sw/app/rocon/appl_pxmc.c
+++ b/sw/app/rocon/appl_pxmc.c
@@ -2154,6 +2154,22 @@ int pxmc_rocon_pthalalign(pxmc_state_t *mcs, int periods)
   return res;
 }
 
+int pxmc_axis_out_chans4mode(int mode)
+{
+  switch (mode) {
+    case PXMC_AXIS_MODE_DC:
+      return 2;
+    case PXMC_AXIS_MODE_BLDC:
+    case PXMC_AXIS_MODE_BLDC_PXMCC:
+      return 3;
+    case PXMC_AXIS_MODE_STEPPER_WITH_IRC:
+    case PXMC_AXIS_MODE_STEPPER_WITH_IRC_PXMCC:
+    case PXMC_AXIS_MODE_STEPPER_PXMCC:
+      return 4;
+  }
+  return -1;
+}
+
 int pxmc_axis_rdmode(pxmc_state_t *mcs)
 {
   if (mcs->pxms_do_out == pxmc_rocon_pwm2ph_out)
@@ -2171,7 +2187,6 @@ int pxmc_axis_rdmode(pxmc_state_t *mcs)
   return -1;
 }
 
-
 int
 pxmc_axis_pt4mode(pxmc_state_t *mcs, int mode)
 {