Optimization and benchmark

Optimized design 2's pointCP's rotatePoint method (only needs to add
angle since it's already polar).
Benchmarked design 2 with TestDesign.