AngleViaPoint: dead code cleanup

Deleted a lot of unneeded code (most procedures
addConstraintTangentXXX2YYY)
+ added some range checking and dumping errors to console.