For the project in AGH

Dependencies:   mbed Servo BSP_DISCO_F413ZH

Committer:
manumanumanu
Date:
Mon Jun 27 09:58:29 2022 +0000
Revision:
0:401936269c3e
Servos;

Who changed what in which revision?

UserRevisionLine numberNew 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