Rev 194 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 194 | Rev 224 | ||
---|---|---|---|
Line 103... | Line 103... | ||
103 | 103 | ||
104 | winkel = pgm_read_word(&pgm_sinus[winkel]); |
104 | winkel = pgm_read_word(&pgm_sinus[winkel]); |
105 | return (winkel*m*n); |
105 | return (winkel*m*n); |
Line -... | Line 106... | ||
- | 106 | } |
|
- | 107 | ||
- | 108 | // Aus x,y und Winkel Distanz ermitteln |
|
- | 109 | long get_dist(signed int x, signed int y, signed int phi) |
|
- | 110 | { |
|
- | 111 | long dist; |
|
- | 112 | if (abs(x) > abs(y) ) |
|
- | 113 | { |
|
- | 114 | dist = (long) x; //Groesseren Wert wegen besserer Genauigkeit nehmen |
|
- | 115 | dist = abs((dist *1000) / (long) sin_i(phi)); |
|
- | 116 | } |
|
- | 117 | else |
|
- | 118 | { |
|
- | 119 | dist = (long) y; |
|
- | 120 | dist = abs((dist *1000) / (long) cos_i(phi)); |
|
- | 121 | } |
|
- | 122 | return dist; |