Lynxmotion Phoenix code ported to Trossen PhantomX