/*
 * _3pi_BatteryControl.cpp
 *
 * Created: 23/10/2014 18:03:09
 *  Author: noname
 */ 

#include "3piLibPack.h"

void run()
{
	display.printNumToXY(getBatteryVoltage(), 4,0);
	send_int(rs232, getBatteryVoltage());
	rs232.send("\n");
	
	waitForButton(BUTTON_A);	// cekam na tlacitko
	setMotorPower(100,100);		// jedu 100
	delay(1000);				// cekam 1000 ms = 1 s
	setMotorPower(0,0);			// zastavim
	
	while(1)
	{
		display.printNumToXY(getBatteryVoltage(), 4,0);
		rs232.send("\n");
		rs232.sendNumber(getBatteryVoltage());
		delay(100);
	}
}