Rewrite CCD Library from sketch, to simply logic

Net Yet Finish