sharp.c

/*******************************************************************************
* examples/sharp.c                                                             *
* ================                                                             *
*                                                                              *
* Version: 1.0.6                                                               *
* Date   : 15.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 testSharp(void);
int main(void);
 
//*********************************[testSharp]**********************************
void testSharp(void) {
 
    int16_t value;
    uint8_t countdown = 0;
    uint8_t flag_convert = 0xFF;
 
    lcdclr();
    lcdstr_p(PSTR("Sharp"           ));
    lcdxy(0,1);
    lcdstr_p(PSTR(" #### #### ####"));
 
    sharps_request(kRequestContinuous);
 
    while (1) {
        if (buttons_get(kButtonMiddle)) {
            leds_set(kLedMiddle, kLedOn );
            mdelay(100);
            leds_set(kLedMiddle, kLedOff);
 
            lcdxy(13,0);
            lcdstr_p(PSTR(            " mm"));
 
            flag_convert = 0xFF;
            countdown = 0;
        } else if (buttons_get(kButtonRight)) {
            leds_set(kLedRight , kLedOn );
            mdelay(100);
            leds_set(kLedRight , kLedOff);
 
            lcdxy(13,0);
            lcdstr_p(PSTR(            "adc"));
 
            flag_convert = 0x00;
            countdown = 0;
        }
 
        if (countdown) {
            countdown--;
        } else {
            countdown = 5;
 
            value = sharps_get(kSharpGetLeft);
            if (flag_convert) {value = sharps_toMm(value);}
            lcdxy( 1,1); int16tostr(lcdout,value,4);
 
            value = sharps_get(kSharpGetMiddle);
            if (flag_convert) {value = sharps_toMm(value);}
            lcdxy( 6,1); int16tostr(lcdout,value,4);
 
            value = sharps_get(kSharpGetRight);
            if (flag_convert) {value = sharps_toMm(value);}
            lcdxy(11,1); int16tostr(lcdout,value,4);
        }
 
        mdelay(100);
    }
}
 
//*********************************[main]***************************************
int main (void) {
 
    init_tucbot(0xFF);
 
    buttons_request(kRequestContinuous);
 
    testSharp();
 
    return (0);
}