Acceleration of real-time Proximity Query for dynamic active constraints

Proximity Query (PQ) is a process to calculate the relative placement of objects. It is a critical task for many applications such as robot motion planning, but it is often too computationally demanding for real-time applications, particularly those involving human-robot collaborative control. This paper derives a PQ formulation which can support non-convex objects represented by meshes or cloud points. We optimise the proposed PQ for reconfigurable hardware by function transformation and reduced precision, resulting in a novel data structure and memory architecture for data streaming while maintaining the accuracy of results. Run-time reconfiguration is adopted for dynamic precision optimisation. Experimental results show that our optimised PQ implementation on a reconfigurable platform with four FPGAs is 58 times faster than an optimised CPU implementation with 12 cores, 9 times faster than a GPU, and 3 times faster than a double precision implementation with four FPGAs.

[1]  Sylvain Miossec,et al.  Fast C1 proximity queries using support mapping of sphere-torus-patches bounding volumes , 2009, 2009 IEEE International Conference on Robotics and Automation.

[2]  Elizabeth A. Croft,et al.  Haptic rendering of rigid contacts using impulsive and penalty forces , 2005, IEEE Transactions on Robotics.

[3]  Brian Mirtich,et al.  V-Clip: fast and robust polyhedral collision detection , 1998, TOGS.

[4]  S. Sathiya Keerthi,et al.  A fast procedure for computing the distance between complex objects in three-dimensional space , 1988, IEEE J. Robotics Autom..

[5]  Xinyu Zhang,et al.  Interactive Collision Detection for Deformable Models Using Streaming AABBs , 2007, IEEE Transactions on Visualization and Computer Graphics.

[6]  Vincent Lefèvre,et al.  MPFR: A multiple-precision binary floating-point library with correct rounding , 2007, TOMS.

[7]  Jean Ponce,et al.  Invariant Properties of Straight Homogeneous Generalized Cylinders and Their Contours , 1989, IEEE Trans. Pattern Anal. Mach. Intell..

[8]  Ming C. Lin,et al.  A fast algorithm for incremental distance calculation , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[9]  Rob A. Rutenbar,et al.  Fast, Accurate Static Analysis for Fixed-Point Finite-Precision Effects in DSP Designs , 2003, ICCAD 2003.

[10]  Brian L. Davies,et al.  The hands-on orthopaedic robot "acrobot": Early clinical trials of total knee replacement surgery , 2003, IEEE Trans. Robotics Autom..

[11]  Nilanjan Chakraborty,et al.  Proximity Queries Between Convex Objects: An Interior Point Approach for Implicit Surfaces , 2006, IEEE Transactions on Robotics.

[12]  F. Frances Yao,et al.  Computational Geometry , 1991, Handbook of Theoretical Computer Science, Volume A: Algorithms and Complexity.

[13]  Elmer G. Gilbert,et al.  Computing the distance between general convex objects in three-dimensional space , 1990, IEEE Trans. Robotics Autom..

[14]  Guang-Zhong Yang,et al.  Dimensionality Reduction in Controlling Articulated Snake Robot for Endoscopy Under Dynamic Active Constraints , 2013, IEEE Transactions on Robotics.

[15]  Franco P. Preparata,et al.  Sequencing-by-hybridization revisited: the analog-spectrum proposal , 2004, IEEE/ACM Transactions on Computational Biology and Bioinformatics.

[16]  Wayne Luk,et al.  Mixed Precision Processing in Reconfigurable Systems , 2011, 2011 IEEE 19th Annual International Symposium on Field-Programmable Custom Computing Machines.

[17]  Guang-Zhong Yang,et al.  Control of Articulated Snake Robot under Dynamic Active Constraints , 2010, MICCAI.

[18]  Wayne Luk,et al.  MiniBit: bit-width optimization via affine arithmetic , 2005, Proceedings. 42nd Design Automation Conference, 2005..

[19]  Wayne Luk,et al.  Instrumented Multi-Stage Word-Length Optimization , 2007, 2007 International Conference on Field-Programmable Technology.

[20]  Russell H. Taylor,et al.  Spatial Motion Constraints Using Virtual Fixtures Generated by Anatomy , 2007, IEEE Transactions on Robotics.

[21]  George A. Constantinides,et al.  Automated Precision Analysis: A Polynomial Algebraic Approach , 2010, 2010 18th IEEE Annual International Symposium on Field-Programmable Custom Computing Machines.