implemented almost every step exactly as in libccv
p=57.79, r=47,41
p=57.79, r=47,41
p=58.67, r=47.52
p=59.71, r=47.48
small changes