worked on angle finding

assumes that at the beginning, all angles are 0.