#include #include "fasttrigon.h" namespace fasttrigon { static const std::array LUT { 0, 3, 6, 9, 12, 15, 18, 21, 25, 28, 31, 34, 37, 40, 43, 47, 50, 53, 56, 59, 62, 65, 68, 72, 75, 78, 81, 84, 87, 90, 94, 97, 100, 103, 106, 109, 112, 115, 118, 122, 125, 128, 131, 134, 137, 140, 143, 147, 150, 153, 156, 159, 162, 165, 168, 171, 174, 177, 181, 184, 187, 190, 193, 196, 199, 202, 205, 208, 211, 214, 218, 221, 224, 227, 230, 233, 236, 239, 242, 245, 248, 251, 254, 257, 260, 263, 266, 269, 272, 275, 278, 281, 284, 287, 290, 293, 296, 299, 302, 305, 308, 311, 314, 317, 320, 323, 326, 329, 332, 335, 338, 341, 344, 347, 350, 353, 356, 359, 362, 365, 368, 371, 374, 376, 379, 382, 385, 388, 391, 394, 397, 400, 403, 405, 408, 411, 414, 417, 420, 423, 426, 428, 431, 434, 437, 440, 443, 445, 448, 451, 454, 457, 459, 462, 465, 468, 471, 473, 476, 479, 482, 485, 487, 490, 493, 496, 498, 501, 504, 506, 509, 512, 515, 517, 520, 523, 525, 528, 531, 533, 536, 539, 541, 544, 547, 549, 552, 555, 557, 560, 563, 565, 568, 570, 573, 576, 578, 581, 583, 586, 589, 591, 594, 596, 599, 601, 604, 606, 609, 611, 614, 616, 619, 621, 624, 626, 629, 631, 634, 636, 639, 641, 644, 646, 648, 651, 653, 656, 658, 661, 663, 665, 668, 670, 672, 675, 677, 679, 682, 684, 687, 689, 691, 693, 696, 698, 700, 703, 705, 707, 709, 712, 714, 716, 718, 721, 723, 725, 727, 729, 732, 734, 736, 738, 740, 743, 745, 747, 749, 751, 753, 755, 757, 760, 762, 764, 766, 768, 770, 772, 774, 776, 778, 780, 782, 784, 786, 788, 790, 792, 794, 796, 798, 800, 802, 804, 806, 808, 810, 812, 814, 816, 817, 819, 821, 823, 825, 827, 829, 830, 832, 834, 836, 838, 839, 841, 843, 845, 847, 848, 850, 852, 854, 855, 857, 859, 860, 862, 864, 865, 867, 869, 870, 872, 874, 875, 877, 879, 880, 882, 883, 885, 886, 888, 890, 891, 893, 894, 896, 897, 899, 900, 902, 903, 905, 906, 908, 909, 910, 912, 913, 915, 916, 917, 919, 920, 922, 923, 924, 926, 927, 928, 930, 931, 932, 933, 935, 936, 937, 939, 940, 941, 942, 943, 945, 946, 947, 948, 949, 951, 952, 953, 954, 955, 956, 957, 958, 959, 961, 962, 963, 964, 965, 966, 967, 968, 969, 970, 971, 972, 973, 974, 975, 976, 977, 978, 978, 979, 980, 981, 982, 983, 984, 985, 985, 986, 987, 988, 989, 990, 990, 991, 992, 993, 993, 994, 995, 996, 996, 997, 998, 998, 999, 1000, 1000, 1001, 1002, 1002, 1003, 1003, 1004, 1005, 1005, 1006, 1006, 1007, 1007, 1008, 1008, 1009, 1010, 1010, 1010, 1011, 1011, 1012, 1012, 1013, 1013, 1014, 1014, 1014, 1015, 1015, 1016, 1016, 1016, 1017, 1017, 1017, 1018, 1018, 1018, 1018, 1019, 1019, 1019, 1019, 1020, 1020, 1020, 1020, 1021, 1021, 1021, 1021, 1021, 1021, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1023, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1022, 1021, 1021, 1021, 1021, 1021, 1021, 1020, 1020, 1020, 1020, 1019, 1019, 1019, 1019, 1018, 1018, 1018, 1018, 1017, 1017, 1017, 1016, 1016, 1016, 1015, 1015, 1014, 1014, 1014, 1013, 1013, 1012, 1012, 1011, 1011, 1010, 1010, 1010, 1009, 1008, 1008, 1007, 1007, 1006, 1006, 1005, 1005, 1004, 1003, 1003, 1002, 1002, 1001, 1000, 1000, 999, 998, 998, 997, 996, 996, 995, 994, 993, 993, 992, 991, 990, 990, 989, 988, 987, 986, 985, 985, 984, 983, 982, 981, 980, 979, 978, 978, 977, 976, 975, 974, 973, 972, 971, 970, 969, 968, 967, 966, 965, 964, 963, 962, 961, 959, 958, 957, 956, 955, 954, 953, 952, 951, 949, 948, 947, 946, 945, 943, 942, 941, 940, 939, 937, 936, 935, 933, 932, 931, 930, 928, 927, 926, 924, 923, 922, 920, 919, 917, 916, 915, 913, 912, 910, 909, 908, 906, 905, 903, 902, 900, 899, 897, 896, 894, 893, 891, 890, 888, 886, 885, 883, 882, 880, 879, 877, 875, 874, 872, 870, 869, 867, 865, 864, 862, 860, 859, 857, 855, 854, 852, 850, 848, 847, 845, 843, 841, 839, 838, 836, 834, 832, 830, 829, 827, 825, 823, 821, 819, 817, 816, 814, 812, 810, 808, 806, 804, 802, 800, 798, 796, 794, 792, 790, 788, 786, 784, 782, 780, 778, 776, 774, 772, 770, 768, 766, 764, 762, 760, 757, 755, 753, 751, 749, 747, 745, 743, 740, 738, 736, 734, 732, 729, 727, 725, 723, 721, 718, 716, 714, 712, 709, 707, 705, 703, 700, 698, 696, 693, 691, 689, 687, 684, 682, 679, 677, 675, 672, 670, 668, 665, 663, 661, 658, 656, 653, 651, 648, 646, 644, 641, 639, 636, 634, 631, 629, 626, 624, 621, 619, 616, 614, 611, 609, 606, 604, 601, 599, 596, 594, 591, 589, 586, 583, 581, 578, 576, 573, 570, 568, 565, 563, 560, 557, 555, 552, 549, 547, 544, 541, 539, 536, 533, 531, 528, 525, 523, 520, 517, 515, 512, 509, 506, 504, 501, 498, 496, 493, 490, 487, 485, 482, 479, 476, 473, 471, 468, 465, 462, 459, 457, 454, 451, 448, 445, 443, 440, 437, 434, 431, 428, 426, 423, 420, 417, 414, 411, 408, 405, 403, 400, 397, 394, 391, 388, 385, 382, 379, 376, 374, 371, 368, 365, 362, 359, 356, 353, 350, 347, 344, 341, 338, 335, 332, 329, 326, 323, 320, 317, 314, 311, 308, 305, 302, 299, 296, 293, 290, 287, 284, 281, 278, 275, 272, 269, 266, 263, 260, 257, 254, 251, 248, 245, 242, 239, 236, 233, 230, 227, 224, 221, 218, 214, 211, 208, 205, 202, 199, 196, 193, 190, 187, 184, 181, 177, 174, 171, 168, 165, 162, 159, 156, 153, 150, 147, 143, 140, 137, 134, 131, 128, 125, 122, 118, 115, 112, 109, 106, 103, 100, 97, 94, 90, 87, 84, 81, 78, 75, 72, 68, 65, 62, 59, 56, 53, 50, 47, 43, 40, 37, 34, 31, 28, 25, 21, 18, 15, 12, 9, 6, 3, 0, -3, -6, -9, -12, -15, -18, -21, -25, -28, -31, -34, -37, -40, -43, -47, -50, -53, -56, -59, -62, -65, -68, -72, -75, -78, -81, -84, -87, -90, -94, -97, -100, -103, -106, -109, -112, -115, -118, -122, -125, -128, -131, -134, -137, -140, -143, -147, -150, -153, -156, -159, -162, -165, -168, -171, -174, -177, -181, -184, -187, -190, -193, -196, -199, -202, -205, -208, -211, -214, -218, -221, -224, -227, -230, -233, -236, -239, -242, -245, -248, -251, -254, -257, -260, -263, -266, -269, -272, -275, -278, -281, -284, -287, -290, -293, -296, -299, -302, -305, -308, -311, -314, -317, -320, -323, -326, -329, -332, -335, -338, -341, -344, -347, -350, -353, -356, -359, -362, -365, -368, -371, -374, -376, -379, -382, -385, -388, -391, -394, -397, -400, -403, -405, -408, -411, -414, -417, -420, -423, -426, -428, -431, -434, -437, -440, -443, -445, -448, -451, -454, -457, -459, -462, -465, -468, -471, -473, -476, -479, -482, -485, -487, -490, -493, -496, -498, -501, -504, -506, -509, -512, -515, -517, -520, -523, -525, -528, -531, -533, -536, -539, -541, -544, -547, -549, -552, -555, -557, -560, -563, -565, -568, -570, -573, -576, -578, -581, -583, -586, -589, -591, -594, -596, -599, -601, -604, -606, -609, -611, -614, -616, -619, -621, -624, -626, -629, -631, -634, -636, -639, -641, -644, -646, -648, -651, -653, -656, -658, -661, -663, -665, -668, -670, -672, -675, -677, -679, -682, -684, -687, -689, -691, -693, -696, -698, -700, -703, -705, -707, -709, -712, -714, -716, -718, -721, -723, -725, -727, -729, -732, -734, -736, -738, -740, -743, -745, -747, -749, -751, -753, -755, -757, -760, -762, -764, -766, -768, -770, -772, -774, -776, -778, -780, -782, -784, -786, -788, -790, -792, -794, -796, -798, -800, -802, -804, -806, -808, -810, -812, -814, -816, -817, -819, -821, -823, -825, -827, -829, -830, -832, -834, -836, -838, -839, -841, -843, -845, -847, -848, -850, -852, -854, -855, -857, -859, -860, -862, -864, -865, -867, -869, -870, -872, -874, -875, -877, -879, -880, -882, -883, -885, -886, -888, -890, -891, -893, -894, -896, -897, -899, -900, -902, -903, -905, -906, -908, -909, -910, -912, -913, -915, -916, -917, -919, -920, -922, -923, -924, -926, -927, -928, -930, -931, -932, -933, -935, -936, -937, -939, -940, -941, -942, -943, -945, -946, -947, -948, -949, -951, -952, -953, -954, -955, -956, -957, -958, -959, -961, -962, -963, -964, -965, -966, -967, -968, -969, -970, -971, -972, -973, -974, -975, -976, -977, -978, -978, -979, -980, -981, -982, -983, -984, -985, -985, -986, -987, -988, -989, -990, -990, -991, -992, -993, -993, -994, -995, -996, -996, -997, -998, -998, -999, -1000, -1000, -1001, -1002, -1002, -1003, -1003, -1004, -1005, -1005, -1006, -1006, -1007, -1007, -1008, -1008, -1009, -1010, -1010, -1010, -1011, -1011, -1012, -1012, -1013, -1013, -1014, -1014, -1014, -1015, -1015, -1016, -1016, -1016, -1017, -1017, -1017, -1018, -1018, -1018, -1018, -1019, -1019, -1019, -1019, -1020, -1020, -1020, -1020, -1021, -1021, -1021, -1021, -1021, -1021, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1023, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1022, -1021, -1021, -1021, -1021, -1021, -1021, -1020, -1020, -1020, -1020, -1019, -1019, -1019, -1019, -1018, -1018, -1018, -1018, -1017, -1017, -1017, -1016, -1016, -1016, -1015, -1015, -1014, -1014, -1014, -1013, -1013, -1012, -1012, -1011, -1011, -1010, -1010, -1010, -1009, -1008, -1008, -1007, -1007, -1006, -1006, -1005, -1005, -1004, -1003, -1003, -1002, -1002, -1001, -1000, -1000, -999, -998, -998, -997, -996, -996, -995, -994, -993, -993, -992, -991, -990, -990, -989, -988, -987, -986, -985, -985, -984, -983, -982, -981, -980, -979, -978, -978, -977, -976, -975, -974, -973, -972, -971, -970, -969, -968, -967, -966, -965, -964, -963, -962, -961, -959, -958, -957, -956, -955, -954, -953, -952, -951, -949, -948, -947, -946, -945, -943, -942, -941, -940, -939, -937, -936, -935, -933, -932, -931, -930, -928, -927, -926, -924, -923, -922, -920, -919, -917, -916, -915, -913, -912, -910, -909, -908, -906, -905, -903, -902, -900, -899, -897, -896, -894, -893, -891, -890, -888, -886, -885, -883, -882, -880, -879, -877, -875, -874, -872, -870, -869, -867, -865, -864, -862, -860, -859, -857, -855, -854, -852, -850, -848, -847, -845, -843, -841, -839, -838, -836, -834, -832, -830, -829, -827, -825, -823, -821, -819, -817, -816, -814, -812, -810, -808, -806, -804, -802, -800, -798, -796, -794, -792, -790, -788, -786, -784, -782, -780, -778, -776, -774, -772, -770, -768, -766, -764, -762, -760, -757, -755, -753, -751, -749, -747, -745, -743, -740, -738, -736, -734, -732, -729, -727, -725, -723, -721, -718, -716, -714, -712, -709, -707, -705, -703, -700, -698, -696, -693, -691, -689, -687, -684, -682, -679, -677, -675, -672, -670, -668, -665, -663, -661, -658, -656, -653, -651, -648, -646, -644, -641, -639, -636, -634, -631, -629, -626, -624, -621, -619, -616, -614, -611, -609, -606, -604, -601, -599, -596, -594, -591, -589, -586, -583, -581, -578, -576, -573, -570, -568, -565, -563, -560, -557, -555, -552, -549, -547, -544, -541, -539, -536, -533, -531, -528, -525, -523, -520, -517, -515, -512, -509, -506, -504, -501, -498, -496, -493, -490, -487, -485, -482, -479, -476, -473, -471, -468, -465, -462, -459, -457, -454, -451, -448, -445, -443, -440, -437, -434, -431, -428, -426, -423, -420, -417, -414, -411, -408, -405, -403, -400, -397, -394, -391, -388, -385, -382, -379, -376, -374, -371, -368, -365, -362, -359, -356, -353, -350, -347, -344, -341, -338, -335, -332, -329, -326, -323, -320, -317, -314, -311, -308, -305, -302, -299, -296, -293, -290, -287, -284, -281, -278, -275, -272, -269, -266, -263, -260, -257, -254, -251, -248, -245, -242, -239, -236, -233, -230, -227, -224, -221, -218, -214, -211, -208, -205, -202, -199, -196, -193, -190, -187, -184, -181, -177, -174, -171, -168, -165, -162, -159, -156, -153, -150, -147, -143, -140, -137, -134, -131, -128, -125, -122, -118, -115, -112, -109, -106, -103, -100, -97, -94, -90, -87, -84, -81, -78, -75, -72, -68, -65, -62, -59, -56, -53, -50, -47, -43, -40, -37, -34, -31, -28, -25, -21, -18, -15, -12, -9, -6, -3 }; int32_t fastsin(int32_t arg) { bool neg = arg < 0; uint32_t idx; if(neg) { idx = (-arg) % LUT_SIZE; return -LUT[idx]; } else { idx = arg % LUT_SIZE; return LUT[idx]; } } int32_t fastcos(int32_t arg) { return fastsin(arg + LUT_SIZE/4); } int32_t fasttan(int32_t arg) { int32_t denom = fastcos(arg); if(denom == 0) { return 0x7FFFFFFF; } int32_t numer = fastsin(arg); return numer * 127 / denom; } }