Cleanup in preparation of catkinization.
Catkinize.
Update copyright, self import guard, and catkinize
PEP8, cleanup, and remove roslib