removed old code, added mark for detected color_triangle
fixed color_triangle calculation