Fixed bad PCL implementation.  Added a few initial tests