svoe
Dependencies: mbed mbed-STM32F103C8T6 MPU6050_1
serva.h@23:bc05a104be10, 2019-08-06 (annotated)
- Committer:
- dima285
- Date:
- Tue Aug 06 14:13:55 2019 +0000
- Branch:
- svoe
- Revision:
- 23:bc05a104be10
- Parent:
- 22:14e85f2068c7
06.08.19
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Stas285 | 0:e9488589a8ee | 1 | PwmOut serva_out(PB_14); |
Stas285 | 0:e9488589a8ee | 2 | |
Stas285 | 0:e9488589a8ee | 3 | void serva(int degrees){ //{-80;80} lim speed (20 deg, 50ms) |
dima285 | 22:14e85f2068c7 | 4 | int microsec = 1300 - degrees*10; |
Stas285 | 0:e9488589a8ee | 5 | //pc.printf("%d \n", microsec); |
Stas285 | 0:e9488589a8ee | 6 | serva_out.pulsewidth_us(microsec); |
Stas285 | 0:e9488589a8ee | 7 | } |
Stas285 | 0:e9488589a8ee | 8 | |
Stas285 | 0:e9488589a8ee | 9 | void serva_init(){ |
Stas285 | 1:e2a6e523bf1f | 10 | serva_out.period_ms(25); |
Stas285 | 0:e9488589a8ee | 11 | serva(0); |
Stas285 | 0:e9488589a8ee | 12 | } |