fixed the bug of back-color
before adding the new constrain code.
before upsampling
before changing the movement
going_back to the old code
before modify the similarity term
修改NormalRegular和ConfidenceMap之前
before adding skel points