Skip to content
Snippets Groups Projects
Commit 19adb1f2 authored by ArmarX User's avatar ArmarX User
Browse files

more pid controller debugoutput

parent 7eaac384
No related branches found
No related tags found
No related merge requests found
......@@ -228,7 +228,8 @@ StringVariantBaseMap JointPWMPositionController::publish(const DebugDrawerInterf
}
return {{"lastTargetVelocity", new Variant(lastTargetVelocity.load())},
{"targetPosition", new Variant(posController.targetPosition)},
{"error", new Variant(posController.targetPosition - posController.currentPosition)},
{"posError", new Variant(posController.targetPosition - posController.currentPosition)},
{"pidError", new Variant(controller.pid->previousError)},
{"filteredVelocity", new Variant(controller.lastActualVelocity.load())},
{"pidIntegralCV", new Variant(controller.pid->integral * controller.pid->Ki)},
{"pidPropCV", new Variant(controller.pid->previousError * controller.pid->Kp)},
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment