public Robot()
{
rsiAdapter = new RSIAdapter();
generator = new TrajectoryGenerator();
position = RobotVector.Zero;
axisPosition = RobotAxisVector.Zero;
HomePosition = RobotVector.Zero;
}
public RobotEmulator(RobotVector homePosition)
{
HomePosition = homePosition;
generator = new TrajectoryGenerator();
position = RobotVector.Zero;
axisPosition = RobotAxisVector.Zero;
correctionBuffor = new List <RobotVector>();
correction = RobotVector.Zero;
}
