-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathgoToDegree.m
58 lines (50 loc) · 1.21 KB
/
goToDegree.m
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
function y = goToDegree(deg1,deg2,deg3,deg4,deg5,deg6)
value1 = (133/45)*deg1 + 364 ;
if( value1 > 630 )
value1 = 630 ;
elseif( value1 < 110 )
value1 = 110 ;
end
value2 = (258/90)*deg2 + 130 ;
if( value2 > 650 )
value2 = 650 ;
elseif( value2 < 110 )
value2 = 110 ;
end
value3 = (127/45)*deg3 + 400 ;
if( value3 > 630 )
value3 = 630 ;
elseif( value3 < 110 )
value3 = 110 ;
end
value4 = (127/45)*deg4 + 386 ;
if( value4 > 630 )
value4 = 630 ;
elseif( value4 < 110 )
value4 = 110 ;
end
if( strcmp(deg5,'horizontal') )
value5 = 590 ;
else
value5 = 348 ;
end
if( strcmp(deg6,'open') )
value6 = 490 ;
else
value6 = 280 ;
end
value1 = round(value1);
value2 = round(value2);
value3 = round(value3);
value4 = round(value4);
value5 = round(value5);
value6 = round(value6);
value1 = int2str(value1);
value2 = int2str(value2);
value3 = int2str(value3);
value4 = int2str(value4);
value5 = int2str(value5);
value6 = int2str(value6);
y = strcat(value1,value2,value6,value4,value5,value3);
%%%%3 and 5
end