For the project in AGH
Dependencies: mbed Servo BSP_DISCO_F413ZH
main.cpp@0:401936269c3e, 2022-06-27 (annotated)
- Committer:
- manumanumanu
- Date:
- Mon Jun 27 09:58:29 2022 +0000
- Revision:
- 0:401936269c3e
Servos;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
manumanumanu | 0:401936269c3e | 1 | #include "mbed.h" |
manumanumanu | 0:401936269c3e | 2 | #include "Servo.h" |
manumanumanu | 0:401936269c3e | 3 | #include "stm32f413h_discovery.h" |
manumanumanu | 0:401936269c3e | 4 | #include "stm32f413h_discovery_ts.h" |
manumanumanu | 0:401936269c3e | 5 | #include "stm32f413h_discovery_lcd.h" |
manumanumanu | 0:401936269c3e | 6 | #include "stdlib.h" |
manumanumanu | 0:401936269c3e | 7 | |
manumanumanu | 0:401936269c3e | 8 | |
manumanumanu | 0:401936269c3e | 9 | DigitalOut myled1(LED1); |
manumanumanu | 0:401936269c3e | 10 | DigitalOut myled2(LED2); |
manumanumanu | 0:401936269c3e | 11 | |
manumanumanu | 0:401936269c3e | 12 | Servo myservo(D9); //PIN D9 |
manumanumanu | 0:401936269c3e | 13 | |
manumanumanu | 0:401936269c3e | 14 | |
manumanumanu | 0:401936269c3e | 15 | int main() |
manumanumanu | 0:401936269c3e | 16 | { |
manumanumanu | 0:401936269c3e | 17 | BSP_LCD_Init(); |
manumanumanu | 0:401936269c3e | 18 | BSP_LCD_Clear(LCD_COLOR_WHITE); |
manumanumanu | 0:401936269c3e | 19 | |
manumanumanu | 0:401936269c3e | 20 | int counter=0; |
manumanumanu | 0:401936269c3e | 21 | |
manumanumanu | 0:401936269c3e | 22 | myled1 = 0; //LED1 is OFF |
manumanumanu | 0:401936269c3e | 23 | myled2 = 0; //LED2 is OFF |
manumanumanu | 0:401936269c3e | 24 | |
manumanumanu | 0:401936269c3e | 25 | |
manumanumanu | 0:401936269c3e | 26 | BSP_LCD_SetTextColor(LCD_COLOR_BLACK); |
manumanumanu | 0:401936269c3e | 27 | |
manumanumanu | 0:401936269c3e | 28 | while(1) { |
manumanumanu | 0:401936269c3e | 29 | |
manumanumanu | 0:401936269c3e | 30 | |
manumanumanu | 0:401936269c3e | 31 | for(counter=0; counter<100; counter++) { |
manumanumanu | 0:401936269c3e | 32 | myservo = counter/100.0; |
manumanumanu | 0:401936269c3e | 33 | wait(0.01); |
manumanumanu | 0:401936269c3e | 34 | myled1 = 1; |
manumanumanu | 0:401936269c3e | 35 | myled2 = 0; |
manumanumanu | 0:401936269c3e | 36 | BSP_LCD_DisplayStringAt(0, 80, (uint8_t *)"counter-clockwise", CENTER_MODE); |
manumanumanu | 0:401936269c3e | 37 | } |
manumanumanu | 0:401936269c3e | 38 | BSP_LCD_Clear(LCD_COLOR_WHITE); |
manumanumanu | 0:401936269c3e | 39 | for(counter=100; counter>0; counter--) { |
manumanumanu | 0:401936269c3e | 40 | myservo = counter/100.0; |
manumanumanu | 0:401936269c3e | 41 | wait(0.01); |
manumanumanu | 0:401936269c3e | 42 | myled1 = 0; |
manumanumanu | 0:401936269c3e | 43 | myled2 = 1; |
manumanumanu | 0:401936269c3e | 44 | BSP_LCD_DisplayStringAt(0, 80, (uint8_t *)"clockwise", CENTER_MODE); |
manumanumanu | 0:401936269c3e | 45 | } |
manumanumanu | 0:401936269c3e | 46 | BSP_LCD_Clear(LCD_COLOR_WHITE); |
manumanumanu | 0:401936269c3e | 47 | |
manumanumanu | 0:401936269c3e | 48 | |
manumanumanu | 0:401936269c3e | 49 | |
manumanumanu | 0:401936269c3e | 50 | |
manumanumanu | 0:401936269c3e | 51 | |
manumanumanu | 0:401936269c3e | 52 | |
manumanumanu | 0:401936269c3e | 53 | } |
manumanumanu | 0:401936269c3e | 54 | } |
manumanumanu | 0:401936269c3e | 55 | |
manumanumanu | 0:401936269c3e | 56 |