Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- C
- /
- /
- /
- /
- /
- A - - - - - B
- source_direction=atan2(a+b+2c,a-b)*180/pi;
- if(a>b){
- if(b>c){//a>b>c
- possible_center_direction=240; //A is closest, then B, last C
- }else if(a>c){//a>c>b
- possible_center_direction=180; //A is closest, then C last B
- }else{//c>a>b
- possible_center_direction=120; //C is closest, then A last B
- }
- }else{
- if(c>b){//c>b>a
- possible_center_direction=60; //C is closest, then B, last A
- }else if(a>c){//b>a>c
- possible_center_direction=300; //B is closest, then A, last C
- }else{//b>c>a
- possible_center_direction=0; //B is closest, then C, last A
- }
- }
- //if the source is out of bounds, then rotate it by 180 degrees.
- if((possible_center_direction+60)<source_direction){
- if(source_direction>(possible_center_direction-60)){
- source_direction=(source_direction+180)%360;
- }
- }
- true_true_direction = true_true_direction*0.9+source_direction*0.1;
Add Comment
Please, Sign In to add comment