Initial version of pppvvv->orbital elements (port of matlab)