fix angles calculation and enchance pony AI