|
36 | 36 | const double MAX_TILT_ANGLE = 31;
|
37 | 37 | const double MIN_TILT_ANGLE = -31;
|
38 | 38 |
|
39 |
| - |
40 | 39 | int freenect_set_tilt_in_degrees(freenect_device *dev, double angle)
|
41 | 40 | {
|
42 |
| - int ret; |
43 |
| - uint8_t empty[0x1]; |
44 |
| - angle = (((angle<MIN_TILT_ANGLE)?MIN_TILT_ANGLE:angle)>MAX_TILT_ANGLE)?MAX_TILT_ANGLE:((angle<MIN_TILT_ANGLE)?MIN_TILT_ANGLE:angle); |
45 |
| - angle = angle * 2; |
46 |
| - ret = fnusb_control(&dev->usb_motor, 0x40, 0x31, (uint16_t)angle, 0x0, empty, 0x0); |
47 |
| - return ret; |
48 |
| - |
| 41 | + int ret; |
| 42 | + uint8_t empty[0x1]; |
| 43 | + angle = (((angle<MIN_TILT_ANGLE)?MIN_TILT_ANGLE:angle)>MAX_TILT_ANGLE)?MAX_TILT_ANGLE:((angle<MIN_TILT_ANGLE)?MIN_TILT_ANGLE:angle); |
| 44 | + angle = angle * 2; |
| 45 | + ret = fnusb_control(&dev->usb_motor, 0x40, 0x31, (uint16_t)angle, 0x0, empty, 0x0); |
| 46 | + return ret; |
49 | 47 | }
|
50 | 48 |
|
51 | 49 | int freenect_set_tilt_in_radians(freenect_device *dev, double angle)
|
52 | 50 | {
|
53 |
| - int ret; |
54 |
| - angle = angle/M_PI*180; |
55 |
| - ret = freenect_set_tilt_in_degrees(dev,angle); |
56 |
| - return ret; |
57 |
| - |
| 51 | + int ret; |
| 52 | + angle = angle/M_PI*180; |
| 53 | + ret = freenect_set_tilt_in_degrees(dev,angle); |
| 54 | + return ret; |
58 | 55 | }
|
59 | 56 |
|
60 | 57 | int freenect_set_led(freenect_device *dev, freenect_led_options option)
|
61 | 58 | {
|
62 |
| - int ret; |
63 |
| - uint8_t empty[0x1]; |
64 |
| - ret = fnusb_control(&dev->usb_motor, 0x40, 0x06, (uint16_t)option, 0x0, empty, 0x0); |
65 |
| - return ret; |
66 |
| - |
| 59 | + int ret; |
| 60 | + uint8_t empty[0x1]; |
| 61 | + ret = fnusb_control(&dev->usb_motor, 0x40, 0x06, (uint16_t)option, 0x0, empty, 0x0); |
| 62 | + return ret; |
67 | 63 | }
|
68 |
| - |
69 |
| - |
0 commit comments