servo.c

/*******************************************************************************
* examples/servo.c                                                             *
* ================                                                             *
*                                                                              *
* Version: 1.0.4                                                               *
* Date   : 01.11.17                                                            *
* Author : Peter Weissig                                                       *
*                                                                              *
* If you are changing this file, you may also consider to update               *
*     demos/diagnosticTool/diagnosticTool.c                                    *
*******************************************************************************/
 
//*********************************<Included files>*****************************
#include <tucbot/tucbot.h>
 
//*********************************<Methods>************************************
void testServo(void);
int main(void);
 
//*********************************[testServo]**********************************
void testServo(void) {
 
    int8_t pos = 0;
 
    lcdclr();
    lcdstr_p(PSTR("Servo"           ));
    lcdxy(0,1);
    lcdstr_p(PSTR("###" "\xDF" "    <+> <-> "));
 
    while (1) {
        if (buttons_get(kButtonMiddle)) {
            leds_set(kLedMiddle, kLedOn );
            mdelay(100);
            leds_set(kLedMiddle, kLedOff);
 
            if (pos <  70) {
                pos++;
                lcdxy(0,1);
                int16tostr(lcdout,pos,3);
            }
            servo_set(pos);
 
        } else if (buttons_get(kButtonRight)) {
            leds_set(kLedRight , kLedOn );
            mdelay(100);
            leds_set(kLedRight , kLedOff);
 
            if (pos > -70) {
                pos--;
                lcdxy(0,1);
                int16tostr(lcdout,pos,3);
            }
            servo_set(pos);
        }
    }
}
 
//*********************************[main]***************************************
int main (void) {
 
    init_tucbot(0xFF);
 
    buttons_request(kRequestContinuous);
 
    testServo();
 
    return (0);
}