Vladlen Koltun Pianos are not flat: rigid motion planning in three dimensions. 505-514 2005 conf/soda/2005 SODA http://doi.acm.org/10.1145/1070432.1070502 db/conf/soda/soda2005.html#Koltun05