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; }