root/trunk/lib/angles.py @ 13580
| 1 | 1606 | aaronmk | # Angles
|
|---|---|---|---|
| 2 | |||
| 3 | rev_deg = 360 |
||
| 4 | |||
| 5 | compass_dir_headings = {'N': 0, 'E': 90, 'S': 180, 'W': 270} |
||
| 6 | |||
| 7 | def compass2heading(compass): |
||
| 8 | heading = None |
||
| 9 | for dir_ in reversed(compass): |
||
| 10 | dir_heading = compass_dir_headings[dir_] |
||
| 11 | if heading == None: heading = dir_heading |
||
| 12 | else: |
||
| 13 | sum_ = dir_heading + heading |
||
| 14 | if abs(dir_heading - heading) > rev_deg/2: sum_ += rev_deg |
||
| 15 | heading = sum_/2. % rev_deg |
||
| 16 | return heading |