corrected methods, added dealing with parallel and intersected lines
corrected methods, added dealing with parallel and intersected lines

KITrokopter/Control-Application,KITrokopter/Control-Application,KITrokopter/Control-Application