Updated with inside triangle test

Also fixed plane fit to test collinearity, replaced normMatrix with norm