Improve TwoWayReentrantReadWriteLock, CPS TODO

Signed-off-by: Ross Allan <rallanpcl@gmail.com>