void swim(double charge, double p, double theta, double phi, vector<HepVector*> &traj);