[JewishDan18]

My code finds the position of the robot and its orientation from a single target, at any position on the field. I am working on multiple target tracking, which will be more accurate.