Ft/clean points

@m0hamed 
@sshihata 
Please review 
Dr.'s code has this matrix