January 2016
·
240 Reads
·
21 Citations
This paper presents a pose estimation procedure for tracking attitude and position of a noncooperative tumbling spacecraft during rendezvous and docking maneuvers. The key aspect of the method is that the current state of the target spacecraft is estimated in real-time using a low-resolution depth-image of the scene and a known model of the vehicle. The proposed procedure exploits the iterative closest point algorithm implemented in closed-loop fashion. In order to guarantee stability of the solution, the current pose of the target is predicted onboard by propagating the last estimated state using a dedicated dynamics model of the maneuver. The tracking procedure is initialized with a fast template matching algorithm that determines attitude and position of the target without prior information on its state. The capabilities of the proposed procedure are demonstrated using a full degrees-of-freedom hardware simulator. In these experiments, the Microsoft Kinect v2 sensor is employed for real-time acquisition of the target spacecraft depth image. The results demonstrate the effectiveness of the proposed procedure during docking maneuvers to a noncooperative tumbling target. However, prediction of the current target pose is crucial for algorithm robustness. Nomenclature Symbols C = principal body-fixed Cartesian coordinate system of the chaser spacecraft d = distance of the target spacecraft center of mass from the centroid of D, m D = point cloud of the target spacecraft measured by the rendezvous sensor, m H = Hill's Cartesian coordinate system l = position of the rendezvous sensor with respect to the chaser spacecraft center of mass, m p = position of the target spacecraft center of mass with respect to the rendezvous sensor, m q T = quaternion of the attitude of the coordinate system T with respect to H q T-S = quaternion of the attitude of the coordinate system T with respect to S q* = solution (attitude) of the Iterative Closest Point procedure r = position of the chaser spacecraft center of mass with respect to the target center of mass, m B A R = rotation matrix from the coordinate system A to the system B R(q) = rotation matrix defined by the unit quaternion vector q S = Cartesian coordinate system of the chaser spacecraft rendezvous sensor T = principal body-fixed Cartesian coordinate system of the target spacecraft t = solution (translation) of the Iterative Closest Point procedure, m X = point cloud of the reference target spacecraft geometry defined in the coordinate system S, m D μ = position of the centroid of the point cloud D, m Δθ = sampling angular step for the template matching procedure, rad Superscript a s = vector a whose components are expressed in the coordinate system s (s = H, C, T) X cp = closest point of the point cloud X to the points of D, m