The RMP Motion Controller APIs
GearingCamming.cs
1
35using NUnit.Framework;
36using RSI.RapidCode.dotNET; // Import our RapidCode Library.
37
38#if DOXYGEN // RSI internal documentation use only
39using RSI.RapidCode;
40#endif
41
43[TestFixture]
44[Category("Software")]
45class GearingCamming : SampleAppTestBase
46 {
47 [Test, Timeout(Constants.MAX_TEST_TIME)]
48 public void Camming()
49 {
51 //Create RapidCode Objects
52 Axis moving_axis = controller.AxisGet(Constants.MAIN_AXIS_NUMBER);
53 HelperFunctions.CheckErrors(moving_axis);
54 Axis follower_axis = controller.AxisGet(Constants.DRIVEN_AXIS_NUMBER);
55 HelperFunctions.CheckErrors(follower_axis);
56
57 // Constants
58 const double MAIN_VELOCITY = 50; // Specify your Moving Axis's velocity. - units: Units/Sec (it will do 1 counts / (1/104857) of a revolution every 1 second.)
59 const double MAIN_ACCELERATION = 20; // Specify your Moving Axis's acceleration. - units: Units/Sec^2
60
61 // Commanded Positions
62 double[] movingAxisDistances = { 5, 10, 8 }; // This is the RELATIVE Moving Axis distance, every n revolutions it changes its Driven position. (This is the x-axis)
63 double[] followerAxisPositions = { 10, 20, 10 }; // This is the final ABSOLUTE Driven position, for every 5 revolutions one of this positions gets applied. (This is the y-axis)
64
65 // Command motion on the Driven before the Moving Axis starts
66 follower_axis.MoveCamLinear(moving_axis.NumberGet(),
67 RSIAxisMasterType.RSIAxisMasterTypeAXIS_COMMAND_POSITION, // Use COMMAND for phantoms and ACTUAL for real axis.
68 movingAxisDistances,
69 followerAxisPositions,
70 movingAxisDistances.Length);
71
72 moving_axis.MoveVelocity(MAIN_VELOCITY, MAIN_ACCELERATION); // Command a constant velocity on the master axis, Driven will follow.
73 follower_axis.MotionDoneWait(); // Wait for the cam motion to complet
74 moving_axis.Stop(); // Stop the Moving Axis
76
78 Assert.AreEqual(followerAxisPositions[followerAxisPositions.Length - 1], follower_axis.CommandPositionGet());
79 }
80 [Test, Timeout(Constants.MAX_TEST_TIME)]
81 public void Gearing()
82 {
84 //Create RapidCode Objects
85 Axis moving_axis = controller.AxisGet(Constants.MAIN_AXIS_NUMBER);
86 HelperFunctions.CheckErrors(moving_axis);
87 Axis follower_axis = controller.AxisGet(Constants.DRIVEN_AXIS_NUMBER);
88 HelperFunctions.CheckErrors(follower_axis);
89
90 int numerator = 2; // Specify the numerator of the gearing ratio.
91 int denominator = 1; // Specify the denominator of the gearing ratio.
92
93 // Configure the 'follower' axis to be a follow to the 'moving' axis at a ratio of 2:1, that is,
94 // for every rotation of the Moving Axis axis, the Driven axis will rotate twice.
95 follower_axis.GearingEnable(moving_axis,
96 RSIAxisMasterType.RSIAxisMasterTypeAXIS_COMMAND_POSITION, // If NOT using a Phantom Axis, switch to RSIAxisMasterTypeAXIS_ACTUAL_POSITION
97 numerator,
98 denominator);
99
100 // Perform a S-curve motion on the Moving Axis axis.
101 moving_axis.MoveSCurve(Constants.POSITION,
102 Constants.VELOCITY,
103 Constants.ACCELERATION,
104 Constants.DECELERATION,
105 Constants.JERK_PERCENT);
106
107 moving_axis.MotionDoneWait(); // Wait for motion to finish.
109
111 Assert.That(moving_axis.CommandPositionGet(), Is.EqualTo(Constants.POSITION), "The command position should be equal to POSITION");
112 Assert.That(follower_axis.CommandPositionGet(), Is.EqualTo(Constants.POSITION * (numerator / denominator)), "The command position should be equal to twice POSITION");
113 }
114 }
static void CheckErrors(RapidCodeObject rsiObject)
Check if the RapidCodeObject has any errors.
Helper Functions for checking logged creation errors, starting the network, etc.
double CommandPositionGet()
Get the current command position.
void MoveCamLinear(int32_t masterAxisNumber, RSIAxisMasterType masterFeedbackSource, const double *const masterDistances, const double *const slavePositions, int32_t pointCount)
Enable this Axis to be linear follower (slave) using an electronic cam.
void MoveVelocity(double velocity)
void GearingEnable(int32_t masterAxisNumber, RSIAxisMasterType masterFeedbackSource, int32_t numerator, int32_t denominator)
Enable this Axis to be follower (slave) using electronic gearing.
void MoveSCurve(double position, double vel, double accel, double decel, double jerkPct)
Command a point-to-point S-Curve motion.
Represents a single axis of motion control. This class provides an interface for commanding motion,...
Definition rsi.h:5664
Axis * AxisGet(int32_t axisNumber)
AxisGet returns a pointer to an Axis object and initializes its internals.
int32_t MotionDoneWait()
Waits for a move to complete.
int32_t NumberGet()
Get the axis number.
RSIAxisMasterType
Sources available to a slave Axis for electronic gearing & camming.
Definition rsienums.h:1154