-
Geometric Formulation of Unified Force-Impedance Control on SE(3) for Robotic Manipulators
Authors:
Joohwan Seo,
Nikhil Potu Surya Prakash,
Soomi Lee,
Arvind Kruthiventy,
Megan Teng,
Jongeun Choi,
Roberto Horowitz
Abstract:
In this paper, we present an impedance control framework on the SE(3) manifold, which enables force tracking while guaranteeing passivity. Building upon the unified force-impedance control (UFIC) and our previous work on geometric impedance control (GIC), we develop the geometric unified force impedance control (GUFIC) to account for the SE(3) manifold structure in the controller formulation using…
▽ More
In this paper, we present an impedance control framework on the SE(3) manifold, which enables force tracking while guaranteeing passivity. Building upon the unified force-impedance control (UFIC) and our previous work on geometric impedance control (GIC), we develop the geometric unified force impedance control (GUFIC) to account for the SE(3) manifold structure in the controller formulation using a differential geometric perspective. As in the case of the UFIC, the GUFIC utilizes energy tank augmentation for both force-tracking and impedance control to guarantee the manipulator's passivity relative to external forces. This ensures that the end effector maintains safe contact interaction with uncertain environments and tracks a desired interaction force. Moreover, we resolve a non-causal implementation problem in the UFIC formulation by introducing velocity and force fields. Due to its formulation on SE(3), the proposed GUFIC inherits the desirable SE(3) invariance and equivariance properties of the GIC, which helps increase sample efficiency in machine learning applications where a learning algorithm is incorporated into the control law. The proposed control law is validated in a simulation environment under scenarios requiring tracking an SE(3) trajectory, incorporating both position and orientation, while exerting a force on a surface. The codes are available at https://github.com/Joohwan-Seo/GUFIC_mujoco.
△ Less
Submitted 23 April, 2025;
originally announced April 2025.
-
A Comparison Between Lie Group- and Lie Algebra- Based Potential Functions for Geometric Impedance Control
Authors:
Joohwan Seo,
Nikhil Potu Surya Prakash,
Jongeun Choi,
Roberto Horowitz
Abstract:
In this paper, a comparison analysis between geometric impedance controls (GICs) derived from two different potential functions on SE(3) for robotic manipulators is presented. The first potential function is defined on the Lie group, utilizing the Frobenius norm of the configuration error matrix. The second potential function is defined utilizing the Lie algebra, i.e., log-map of the configuration…
▽ More
In this paper, a comparison analysis between geometric impedance controls (GICs) derived from two different potential functions on SE(3) for robotic manipulators is presented. The first potential function is defined on the Lie group, utilizing the Frobenius norm of the configuration error matrix. The second potential function is defined utilizing the Lie algebra, i.e., log-map of the configuration error. Using a differential geometric approach, the detailed derivation of the distance metric and potential function on SE(3) is introduced. The GIC laws are respectively derived from the two potential functions, followed by extensive comparison analyses. In the qualitative analysis, the properties of the error function and control laws are analyzed, while the performances of the controllers are quantitatively compared using numerical simulation.
△ Less
Submitted 23 January, 2024;
originally announced January 2024.
-
Clustering Techniques for Stable Linear Dynamical Systems with applications to Hard Disk Drives
Authors:
Nikhil Potu Surya Prakash,
Joohwan Seo,
Jongeun Choi,
Roberto Horowitz
Abstract:
In Robust Control and Data Driven Robust Control design methodologies, multiple plant transfer functions or a family of transfer functions are considered and a common controller is designed such that all the plants that fall into this family are stabilized. Though the plants are stabilized, the controller might be sub-optimal for each of the plants when the variations in the plants are large. This…
▽ More
In Robust Control and Data Driven Robust Control design methodologies, multiple plant transfer functions or a family of transfer functions are considered and a common controller is designed such that all the plants that fall into this family are stabilized. Though the plants are stabilized, the controller might be sub-optimal for each of the plants when the variations in the plants are large. This paper presents a way of clustering stable linear dynamical systems for the design of robust controllers within each of the clusters such that the controllers are optimal for each of the clusters. First a k-medoids algorithm for hard clustering will be presented for stable Linear Time Invariant (LTI) systems and then a Gaussian Mixture Models (GMM) clustering for a special class of LTI systems, common for Hard Disk Drive plants, will be presented.
△ Less
Submitted 16 November, 2023;
originally announced November 2023.
-
Contact-rich SE(3)-Equivariant Robot Manipulation Task Learning via Geometric Impedance Control
Authors:
Joohwan Seo,
Nikhil Potu Surya Prakash,
Xiang Zhang,
Changhao Wang,
Jongeun Choi,
Masayoshi Tomizuka,
Roberto Horowitz
Abstract:
This paper presents a differential geometric control approach that leverages SE(3) group invariance and equivariance to increase transferability in learning robot manipulation tasks that involve interaction with the environment. Specifically, we employ a control law and a learning representation framework that remain invariant under arbitrary SE(3) transformations of the manipulation task definiti…
▽ More
This paper presents a differential geometric control approach that leverages SE(3) group invariance and equivariance to increase transferability in learning robot manipulation tasks that involve interaction with the environment. Specifically, we employ a control law and a learning representation framework that remain invariant under arbitrary SE(3) transformations of the manipulation task definition. Furthermore, the control law and learning representation framework are shown to be SE(3) equivariant when represented relative to the spatial frame. The proposed approach is based on utilizing a recently presented geometric impedance control (GIC) combined with a learning variable impedance control framework, where the gain scheduling policy is trained in a supervised learning fashion from expert demonstrations. A geometrically consistent error vector (GCEV) is fed to a neural network to achieve a gain scheduling policy that remains invariant to arbitrary translation and rotations. A comparison of our proposed control and learning framework with a well-known Cartesian space learning impedance control, equipped with a Cartesian error vector-based gain scheduling policy, confirms the significantly superior learning transferability of our proposed approach. A hardware implementation on a peg-in-hole task is conducted to validate the learning transferability and feasibility of the proposed approach.
△ Less
Submitted 18 December, 2023; v1 submitted 28 August, 2023;
originally announced August 2023.
-
Data-Driven Track Following Control for Dual Stage-Actuator Hard Disk Drives
Authors:
Nikhil Potu Surya Prakash,
Joohwan Seo,
Alexander Rose,
Roberto Horowitz
Abstract:
In this paper, we present a frequency domain data-driven feedback control design methodology for the design of tracking controllers for hard disk drives with two-stage actuator as a part of the open invited track 'Benchmark Problem on Control System Design of Hard Disk Drive with a Dual-Stage Actuator' in the IFAC World Congress 2023 (Yokohoma, Japan). The benchmark models are Compared to the trad…
▽ More
In this paper, we present a frequency domain data-driven feedback control design methodology for the design of tracking controllers for hard disk drives with two-stage actuator as a part of the open invited track 'Benchmark Problem on Control System Design of Hard Disk Drive with a Dual-Stage Actuator' in the IFAC World Congress 2023 (Yokohoma, Japan). The benchmark models are Compared to the traditional controller design, we improve robustness and avoid model mismatch by using multiple frequency response plant measurements directly instead of plant models. Disturbance rejection and corresponding error minimization is posed as an H2 norm minimization problem with H infinity and H2 norm constraints. H infinity norm constraints are used to shape the closed loop transfer functions and ensure closed loop stability and H2 norm constraints are used to constrain and/or minimize the variance of relevant.
△ Less
Submitted 3 April, 2023;
originally announced April 2023.
-
Geometric Impedance Control on SE(3) for Robotic Manipulators
Authors:
Joohwan Seo,
Nikhil Potu Surya Prakash,
Alexander Rose,
Jongeun Choi,
Roberto Horowitz
Abstract:
After its introduction, impedance control has been utilized as a primary control scheme for robotic manipulation tasks that involve interaction with unknown environments. While impedance control has been extensively studied, the geometric structure of SE(3) for the robotic manipulator itself and its use in formulating a robotic task has not been adequately addressed. In this paper, we propose a di…
▽ More
After its introduction, impedance control has been utilized as a primary control scheme for robotic manipulation tasks that involve interaction with unknown environments. While impedance control has been extensively studied, the geometric structure of SE(3) for the robotic manipulator itself and its use in formulating a robotic task has not been adequately addressed. In this paper, we propose a differential geometric approach to impedance control. Given a left-invariant error metric in SE(3), the corresponding error vectors in position and velocity are first derived. We then propose the impedance control schemes that adequately account for the geometric structure of the manipulator in SE(3) based on a left-invariant potential function. The closed-loop stabilities for the proposed control schemes are verified using Lyapunov function-based analysis. The proposed control design clearly outperformed a conventional impedance control approach when tracking challenging trajectory profiles.
△ Less
Submitted 5 March, 2025; v1 submitted 15 November, 2022;
originally announced November 2022.
-
Adaptive Model Predictive Control of Wheeled Mobile Robots
Authors:
Nikhil Potu Surya Prakash,
Tamara Perreault,
Trevor Voth,
Zejun Zhong
Abstract:
In this paper, a control algorithm for guiding a two wheeled mobile robot with unknown inertia to a desired point and orientation using an Adaptive Model Predictive Control (AMPC) framework is presented. The two wheeled mobile robot is modeled as a knife edge or a skate with nonholonomic kinematic constraints and the dynamical equations are derived using the Lagrangian approach. The inputs at ever…
▽ More
In this paper, a control algorithm for guiding a two wheeled mobile robot with unknown inertia to a desired point and orientation using an Adaptive Model Predictive Control (AMPC) framework is presented. The two wheeled mobile robot is modeled as a knife edge or a skate with nonholonomic kinematic constraints and the dynamical equations are derived using the Lagrangian approach. The inputs at every time instant are obtained from Model Predictive Control (MPC) with a set of nominal parameters which are updated using a recursive least squares algorithm. The efficacy of the algorithm is demonstrated through numerical simulations at the end of the paper.
△ Less
Submitted 3 January, 2022;
originally announced January 2022.
-
A Computational Approach for Variational Integration of Attitude Dynamics on SO(3)
Authors:
Nikhil Potu Surya Prakash
Abstract:
In this article, a brief description of Discrete Mechanics and Variational Integrators which preserve the symplectic structure of the flow will be provided and a Newton-Raphson algorithm that can be used to solve implicit equations on the SO(3) manifold will be developed. These techniques will be used to simulate the rotational dynamics of a rigid body evolving on the Lie Group SO(3).
In this article, a brief description of Discrete Mechanics and Variational Integrators which preserve the symplectic structure of the flow will be provided and a Newton-Raphson algorithm that can be used to solve implicit equations on the SO(3) manifold will be developed. These techniques will be used to simulate the rotational dynamics of a rigid body evolving on the Lie Group SO(3).
△ Less
Submitted 3 January, 2022;
originally announced January 2022.
-
Data-Driven Strictly Positive Real System Identification with prior System Knowledge
Authors:
Nikhil Potu Surya Prakash,
Zhi Chen,
Roberto Horowitz
Abstract:
Strictly Positive Real (SPR) transfer functions arise in many areas of engineering like passivity theory in circuit analysis and adaptive control to name a few. In many physical systems, it is possible to conclude that the system is Positive Real (PR) or SPR but system identification algorithms might produce estimates which are not SPR. In this paper, an algorithm to approximate frequency response…
▽ More
Strictly Positive Real (SPR) transfer functions arise in many areas of engineering like passivity theory in circuit analysis and adaptive control to name a few. In many physical systems, it is possible to conclude that the system is Positive Real (PR) or SPR but system identification algorithms might produce estimates which are not SPR. In this paper, an algorithm to approximate frequency response data with SPR transfer functions using Generalized Orthonormal Basis Functions (GOBFs) is presented. Prior knowledge of the system helps us to get approximate pole locations, which can then be used to construct GOBFs. Next, a convex optimization problem will be formulated to obtain an estimate of the SPR transfer function.
△ Less
Submitted 11 October, 2021;
originally announced October 2021.
-
Adaptive Feedforward Reference Design for Active Vibration Rejection in Multi-Actuator Hard Disk Drives
Authors:
Zhi Chen,
Nikhil Potu Surya Prakash,
Roberto Horowitz
Abstract:
In December 2017, Seagate unveiled the Multi Actuator Technology to double the data performance of the future generation hard disk drives (HDD). This technology will equip drives with two dual stage actuators (DSA) each comprising of a voice coil motor (VCM) actuator and a piezoelectric micro actuator (MA) operating on the same pivot point. Each DSA is responsible for controlling half of the drive…
▽ More
In December 2017, Seagate unveiled the Multi Actuator Technology to double the data performance of the future generation hard disk drives (HDD). This technology will equip drives with two dual stage actuators (DSA) each comprising of a voice coil motor (VCM) actuator and a piezoelectric micro actuator (MA) operating on the same pivot point. Each DSA is responsible for controlling half of the drive's arms. As both the DSAs operate independently on the same pivot timber, the control forces and torques generated by one can affect the operation of the other and thereby worsening the performance drastically. In this paper, a robust adaptive feedforward controller is designed as an add-on controller to an existing stabilizing feedback controller to reject the disturbances transferred through the common pivot timber by shaping the references to the VCM actuator and the total output of the dual stage system.
△ Less
Submitted 11 October, 2021;
originally announced October 2021.
-
System Identification in Multi-Actuator Hard Disk Drives with Colored Noises using Observer/Kalman Filter Identification (OKID) Framework
Authors:
Nikhil Potu Surya Prakash,
Zhi Chen,
Roberto Horowitz
Abstract:
Multi Actuator Technology in Hard Disk drives (HDDs) equips drives with two dual stage actuators (DSA) each comprising of a voice coil motor (VCM) actuator and a piezoelectric micro actuator (MA) operating on the same pivot point. Each DSA is responsible for controlling half of the drive's arms. As both the DSAs operate independently on the same pivot timber, the control forces and torques generat…
▽ More
Multi Actuator Technology in Hard Disk drives (HDDs) equips drives with two dual stage actuators (DSA) each comprising of a voice coil motor (VCM) actuator and a piezoelectric micro actuator (MA) operating on the same pivot point. Each DSA is responsible for controlling half of the drive's arms. As both the DSAs operate independently on the same pivot timber, the control forces and torques generated by one affect the operation of the other. The feedback controllers might not completely reject these transferred disturbances and a need to design feedforward controllers arises, which require a good model of the disturbance process. The usual system identification techniques produce a biased estimate because of the presence of the runout which is a colored noise. In this paper, we use the OKID framework to estimate this disturbance cross transfer function from the VCM control input of one DSA to the output of the other DSA from the collected time series data corrupted by colored noise.
△ Less
Submitted 25 September, 2021;
originally announced September 2021.
-
Nonlinear control of a swinging pendulum on a wheeled mobile robot with nonholonomic constraints
Authors:
Nikhil Potu Surya Prakash
Abstract:
In this paper, we propose a nonlinear control strategy for swinging up a pendulum to its upright equilibrium position by shaping its swinging energy along with regulating the cart to a desired location. While the base of a usual cart-pole system is restricted to move in a straight line, the present system is allowed to move in the x-y plane with a nonholonomic consraint that its allowable velocity…
▽ More
In this paper, we propose a nonlinear control strategy for swinging up a pendulum to its upright equilibrium position by shaping its swinging energy along with regulating the cart to a desired location. While the base of a usual cart-pole system is restricted to move in a straight line, the present system is allowed to move in the x-y plane with a nonholonomic consraint that its allowable velocity is only along its orientation. A simple time invariant control law has been presented and its effectiveness has been demonstrated using numerical experiments.
△ Less
Submitted 18 November, 2018;
originally announced November 2018.
