Beiträge von schub

Thanks for your replies. They pointed me in the right direction as it seems. The error does not occur anymore but since there was no way to reproduce this error, I can't be sure.

Here is what I did (pseudocode with only relevant parts):

class MxaController {

  private KRC_INVERSE _krcInverse;
  private RobotState _state;

  // this loops runs every 40ms
  private void Loop() {
    switch (_state) {
      case RoboState.IK:
        _krcInverse.OnCycle();
        if (_krcInverse.DONE) {
          if (_krcInverse.ERROR) {
            // error handling
          }
          else 
          {
            MoveRobotToAxisPosition(_krcInverse.AXISPOSITION);
          }
        }
        else if (_krcInverse.ABORTED)
        {
          // error handling
        }
    }
  }

  public void MoveRobotToAxisPosition(E6AXIS axis)
  {
    // create PLC function block for moving to axis position
    // ...
  }

  public void ComputeIk(E6POS pos) 
  {
    _krcInverse = new KRC_INVERSE();

    _krcInverse.AXISGROUPIDX = _axisGroupIdx;
    _krcInverse.EXECUTECMD = true;
    _krcInverse.POSITION = _nextE6Pos;
    _krcInverse.POSVALIDS = false;
    _krcInverse.POSVALIDT = false;
    _krcInverse.START_AXIS = _lastE6Axis;
    _krcInverse.CHECKSOFTEND = true;
    _krcInverse.BUFFERMODE = 2;

    _state = RobotState.IK;
  }
}

Yes, I should create the KRC_INVERSE function block and set parameters and only check if its done inside the loop without setting all the properties again (even though they stay the same). Thanks for your reply, I will try this approach and will post results here.

Nevertheless, if anyone can tell me, what the `OnCycle()` method is doing, it would be great, since I could not find any documentation about it. Maybe it helps to better understand the mxAutomation library.

Thanks for your reply. This block is running in a loop every 40ms, so at a certain point, the IF condition is evaluated and returns a result, which is then used to move to an axis position.

This is my first project with Kuka, MxAutomation and C# and I made my way to this point using the example program provided by Kuka when I purchased MxAutomation. So what happens is, in each loop all properties of the `KRC_INVERSE` are defined. My app has a slightly different structure than in the first code block (didn't want to put all this code there in the first place)

But to start from the beginning: My initial problem was, that I was not able to move the robot using cartesian coordinates. I tried the function block: `KRC_MoveDirectAbsolute` which was not working at all. Always got the error that `STATUS` and `TURN` where incorrect and I could not figure out how to determine valid values. When moving the robot using the SmartPad and watching the actual position, those values are constantly changing even if the robot moves from one axis position to another. This makes sense, but when defining this function block, I had no clue what to specify. So, my approach was to use `KRC_INVERSE` in order to first let KRC compute the axis position and then I can use these data to actual move the robot in a position I want to. If you have a hint for this problem, help is much appreciated.

But coming back to the problem. In the class which controls the robot there is a function `MoveToCartesianPosition(E6POS pos) { ... }` In this function i create an instance of the function block `KRC_INVERSE`. And then in another function `Loop()`, which runs every 40ms, there is a state machine which actually does the part of setting all the properties of this function block and evaluates the result. Reading you reply, I assume, I don't need to define all properties every loop, correct? Could this causing the error? And what does the Method `OnCycle()` which every KRC function block has?

The program works, only sometimes, the function block returns zero values for all axis. One can see it, in the video below where the robot goes to this position (around second 7) and then continues painting and dancing.

so verwende ich den Baustein:

KRC_INVERSE _krcInverse = new KRC_INVERSE();

_krcInverse.AXISGROUPIDX = _axisGroupId;
_krcInverse.EXECUTECMD = true;
_krcInverse.POSITION = _nextE6Pos;
_krcInverse.POSVALIDS = false;
_krcInverse.POSVALIDT = false;
_krcInverse.START_AXIS = _lastE6Axis;
_krcInverse.CHECKSOFTEND = true;
_krcInverse.BUFFERMODE = 2;
_krcInverse.OnCycle();

if (_krcInverse.DONE)
{
  if (_krcInverse.ERROR)
  {
    // LOG error
  } else 
  {
    E6AXIS pos = _krcInverse.AXISPOSITION;
    // diese Achsen-position wird als nächstes angefahren
  }
}

// notes: 
// _nextE6Pos => axis position of type E6POS
// _lastE6Axis => axis position of type E6AXIS

Hallo zusammen,

Ich steuere einen Kuka Agilus via UDP unter Verwendung von mxAutomation. Zur Berechnung einer Achsenposition verwende ich den Funktionsbaustein KRC_INVERSE. Dieser liefert aber manchmal null Werte (A1=0, A2=0, A3=0, A4=0, A5=0, A6=0) für alle Achsen obwohl ich ihm einen Punkt gebe, der definitiv nicht zu diesem Ergebnis führen sollte. Der Funktionsbaustein wirft keinen Fehler (ERROR = false), trotzdem passiert das. Ich kann den Fehler auch nicht wirklich reproduzieren. Hat jemand eine Idee warum das passiert, oder wie ich das weiter debuggen kann?

Ich verwende Unity mit der mxAutomation Library unter Windows.