double r2p(double x, double y, double *theta);