Use a simplified formulation of the relative task

[ymontmarin]

This PR use a simpler formulation of the relative task, discarding some matrix multiplication in the Jacobian computation.
It follows the discussion in: #80

It also changes the cost setting, to match the typing signature of the function and add the calculus of the jacobian in the description.

[stephane-caron]

Thank you for this contribution 😃

We can expect the following test to fail: test_relative_jacobian (in tests/test_relative_frame_task.py) since you changed the sign of the Jacobian: you can simply put a minus in front of J_check, that should do it.

[coveralls]

Pull Request Test Coverage Report for Build 8483559586

Details

• 9 of 21 (42.86%) changed or added relevant lines in 1 file are covered.
• No unchanged relevant lines lost coverage.
• Overall coverage decreased (-0.6%) to 98.84%

---

Changes Missing Coverage	Covered Lines	Changed/Added Lines	%
pink/tasks/relative_frame_task.py	9	21	42.86%

Totals
Change from base Build 8481800866:	-0.6%
Covered Lines:	1278
Relevant Lines:	1293

---

💛 - Coveralls

[ymontmarin]

@stephane-caron I don't get the last formatting error concerning type annotation. Could you help ?

[stephane-caron]

@stephane-caron I don't get the last formatting error concerning type annotation. Could you help ?

The previous workaround for this was:

        if isinstance(self.cost, np.ndarray):  # helps mypy
            self.cost[0:3] = position_cost

MyPy is stating that the type if inferred for self.cost is float | Sequence[float] | ndarray[Any, Any] | None, which is correct since that's what we told it in the base class Task. (With such a general type we cannot evaluate self.cost[0:3], say if e.g. the runtime type is float or None.)

Looking at it again we can do better by adding a more precise type annotation in the class itself:

class RelativeFrameTask(Task):
    cost: np.ndarray
    frame: str
    ...

I checked locally and it fixes the MyPy error, so I suggest we go for that one ☝️

[stephane-caron]

LGTM 👍 Feel free to merge.

[ymontmarin]

@stephane-caron You can merge if you think its ready !