#include <armarx/control/common/control_law/TaskspaceAdmittanceController.h>

Classes
struct	RtStatus
	internal status of the controller, containing intermediate variables, mutable targets More...

Public Types
using	Config = common::control_law::arondto::TaskspaceAdmittanceControllerConfig

using	ConfigDict = common::control_law::arondto::TaskspaceAdmittanceControllerConfigDict

using	FTConfig = common::ft::arondto::FTConfig

Public Member Functions
void	firstRun ()

void	initialize (const VirtualRobot::RobotNodeSetPtr &rns, const VirtualRobot::RobotNodeSetPtr &rtRns)

void	preactivateInit (const VirtualRobot::RobotNodeSetPtr &rns)

void	run (Config &c, RtStatus &robotStatus)

Public Attributes
common::ft::FTSensor	ftsensor

unsigned int	numOfJoints

VirtualRobot::RobotNodePtr	rtTCP

VirtualRobot::RobotNodePtr	tcp

Detailed Description

Definition at line 40 of file TaskspaceAdmittanceController.h.

Member Typedef Documentation

◆ Config

using Config = common::control_law::arondto::TaskspaceAdmittanceControllerConfig

Definition at line 44 of file TaskspaceAdmittanceController.h.

◆ ConfigDict

using ConfigDict = common::control_law::arondto::TaskspaceAdmittanceControllerConfigDict

Definition at line 45 of file TaskspaceAdmittanceController.h.

◆ FTConfig

using FTConfig = common::ft::arondto::FTConfig

Definition at line 43 of file TaskspaceAdmittanceController.h.

Member Function Documentation

◆ firstRun()

void firstRun ( )

Definition at line 36 of file TaskspaceAdmittanceController.cpp.

Here is the call graph for this function:

◆ initialize()

void initialize	(	const VirtualRobot::RobotNodeSetPtr &	rns,
		const VirtualRobot::RobotNodeSetPtr &	rtRns
	)

Definition at line 16 of file TaskspaceAdmittanceController.cpp.

Here is the call graph for this function:

◆ preactivateInit()

void preactivateInit ( const VirtualRobot::RobotNodeSetPtr & rns )

Definition at line 31 of file TaskspaceAdmittanceController.cpp.

◆ run()

void run	(	Config &	c,
		RtStatus &	robotStatus
	)

run in rt thread

-------------------------— safety guard by FT and target pose ---------------------—

this should not be moved to non rt, just in case non rt thread dies, rt still functions as safely

---------------------------— compute jacobi ---------------------------------------—

---------------------------— update velocity/twist --------------------------------—

-------------------------— admittance control ------------------------------------------— calculate pose error between the virtual pose and the target pose

admittance control law and Euler Integration -> virtual pose

----------------------------------— Impedance control -----------------------------— calculate pose error between target pose and current pose !!! This is very important: you have to keep postion and orientation both with UI unit (meter, radian) to calculate impedance force.

--------------------------— Nullspace PD Control ----------------------------------—

--------------------------— Map TS target force to JS -----------------------------—

--------------------------— write torque target ----------------------------------—

Definition at line 66 of file TaskspaceAdmittanceController.cpp.

Here is the call graph for this function: