1package calc
 2
 3import "math"
 4
 5func AngleDiff(firstAngle, secondAngle float64) float64 { // in rads
 6	difference := secondAngle - firstAngle
 7	for difference < -math.Pi {
 8		difference += math.Pi * 2
 9	}
10	for difference > math.Pi {
11		difference -= math.Pi * 2
12	}
13	return difference
14}