Add prio if triangle of right size and place in 3D
Add values to test with tennis ball
Add help methods instead of having everything done in trackObject, aka cleaning up the code a bit