EmPRISE Robotics Laboratory

Contact-Rich Planning for Safe Whole-arm Manipulation and Control

I am researching contact-rich global planning for whole-arm manipulation (first-author), focusing on ways to combine Model Predictive Control with offline planning to enable robot arms to move around humans while safely making contact across the entire robot arm and regulating contact forces. I am specifically using a robot arm equipped with 28 external haptic force sensors (taxels) so that MPC can regulate forces in real time. My key insight is that reasoning about manipulability at contact locations as part of the cost function in sampling-based planning should create trajectories that ensure the robot has enough flexibility of movement at contact points for the MPC to effectively regulate contact forces, avoid local minima, and safely react to unexpected human movements with minimal disruption to the overall goal. Guiding the MPC along the least dangerous path should allow for more effective and safe robotics for pHRI.

My current approach relies on specifically maximizing √det(JJ’), a metric of the volume of the manipulability ellipsoid, using the contact-Jacobian for each contact location. I am specifically reasoning about the manipulability of the closest taxels, adjusting their cost weighting as a function of distance to the obstacle. The task-space RRT algorithm I developed also uses taxel contact sampling similar to GQDP by running collision-aware inverse kinematics (Mink) to bring the closest taxel at a given node into contact with the obstacle surface. Planning with such whole-arm contacts greatly increases the workspace of the robot in pHRI and is often essential for task completion. I am utilizing both PyBullet and MuJoCo as part of this project.

This experience has been absolutely crucial with regards to understanding and experiencing the full cycle of research. I worked on my own research project with complete independence other than weekly advisor meetings: performing literature review, narrowing down key exploration topics and strategies, building code infrastructure, deriving and implementing various original algorithms, testing my methods, adjusting my focus, iterating, and writing reports on my findings.

Multimodal Training of Latent Dynamics for Contact-Aware MPC

For a separate paper (in development), I was in charge of training a latent dynamics model on robot manipulation tasks using various sensor modalities, focusing on robotic assistance and pHRI scenarios. These included whole-arm tactile sensors, an RGB-D camera, and proprioception (joint states and velocities over time). By capturing and predicting complex contact-rich interactions, the latent model improves the performance of model predictive control for manipulation tasks with whole-arm contact. I determined which scenarios would be best for demonstrating the method, set up and ran experiments, and wrote parts of the paper.

Next
Next

Robot Learning: State-Adaptive MPQ(λ) with Ensemble Q-Networks