int main()
{
printf("press a to send hydro\npress b to send solar\npress up to send flag\n\n");
while(!a_button() && !b_button() && !up_button());
if(a_button())
{
while(a_button());
init_captain_planet_with_our_powers_combined();
kill_process(TIMER_WATCHDOG_ID);
printf("result of charge: %d\n",charge(HYDRO));
}
else if(b_button())
{
while(b_button());
init_captain_planet_with_our_powers_combined();
kill_process(TIMER_WATCHDOG_ID);
printf("result of charge: %d\n",charge(SOLAR));
}
else if(up_button())
{
while(up_button());
init_captain_planet_with_our_powers_combined();
kill_process(TIMER_WATCHDOG_ID);
printf("result of charge: %d\n",charge(FLAG));
}
kill_process(TIMER_PROCESS_ID);
serializer_disconnect();
}
int main()
{
create_connect();
float x=.45;
if(black_button() == 1)
{
create_drive_straight(-100);
sleep(10);
create_stop();
}
while(left_button() == 0)
{
while(black_button() == 0)
{
if (a_button() == 1)
{
x=x+.001;
printf("%f\n", x);
sleep(.5);
}
if (b_button() == 1)
{
x=x-.001;
printf("%f\n", x);
sleep(.5);
}
if (up_button() == 1)
{
x=x+.0001;
printf("%f\n", x);
sleep(.5);
}
if (down_button() == 1)
{
x=x-.0001;
printf("%f\n", x);
sleep(.5);
}
}
create_spin_CW(450);
sleep(x);
create_stop();
}
}
void main(){
int X = 0;
create_connect();
set_create_distance(0);
set_create_total_angle(0);
enable_servos();
armPosBlockStack1();
clawStack1();
/* create_drive(-500,-380);
sleep(2.3);
create_stop();
}
*/
// writeToFile();
printf("%f",seconds());
while(1) //black_button
{
if (a_button()){
testDrive();
}
if (b_button()){
testDetectPVC();
}
if (up_button()){
}
if (down_button()){
testTurnAdjust();
}
if (left_button()){
testTurnCCW();
}
if (right_button()){
testTurnCW();
}
}
}
static void create_point_selector(void)
{
int i;
char tmpbuf [1024];
event_def_t *ep;
GtkWidget *wp;
for (i = 0; i < g_neventdefs; i++) {
ep = &g_eventdefs[i];
sprintf(tmpbuf, "[%lu] %s", ep->event,
ep->name ? ep->name : "(none)");
/* Hack to reduce width of point selectors */
if (strlen(tmpbuf) > 50) {
tmpbuf[50] = 0;
}
wp = gtk_check_button_new_with_label (tmpbuf);
s_event_buttons[i] = wp;
gtk_signal_connect (GTK_OBJECT(wp), "toggled",
GTK_SIGNAL_FUNC(point_select_callback),
(gpointer) (unsigned long long) i);
gtk_toggle_button_set_active (
GTK_TOGGLE_BUTTON(wp), TRUE);
gtk_box_pack_start(GTK_BOX(s_pointselbox), wp, FALSE, FALSE, 0);
}
/* set up scroll parameters by faking an up-button */
s_min_shown_pointsel = 1;
up_button();
gtk_box_pack_start(GTK_BOX(s_pointselbox), s_pointselbuttons, FALSE,
FALSE, 0);
gtk_widget_show(s_pointselbuttons);
gtk_widget_show(s_pointselbox);
gtk_widget_show(s_ps_vscroll);
}
void kissSimComputerDraw()
{
int oriX=ksWindow.simWidth, oriY=0, i;
static char digitals[]="0 0 0 0 0 0 0 0";
static char buttons[]="0 0 0 0 0 0 0";
static char analogs[11][10]={" "," "," "," "," "," "," "," "," "," "," "};
static char actuators[4][25]={" "," "," "," "};
static char servos[4][25]={" "," "," "," "};
if(!glfwGetWindowParam(GLFW_OPENED)) return;
graphics_rectangle_fill(oriX,oriY,oriX+1,ksWindow.height,BLACK); // draw left border
draw_bg(oriX+5,oriY+9,0.36); // Botguy
NOBOLD g_printString(" CBC SIMULATOR",oriX+25, oriY+10,TEAL,1.0);
NOBOLD g_printString(" DIGITALS ",oriX+25, oriY+40,TEAL,1.0);
NOBOLD g_printString("0 1 2 3 4 5 6 7",oriX+25, oriY+55,TEAL,1.0);
NOBOLD g_printString(" BUTTONS ",oriX+25, oriY+90,TEAL,1.0);
//NOBOLD g_printString("< ^ V > A B .",oriX+30, oriY+105,TEAL,1.0);
NOBOLD g_printString("\xb \xd \xe \xc A B .",oriX+30, oriY+105,TEAL,1.0);
// hex b, c, d, e are left, right, up, and down arrows
NOBOLD g_printString(digitals,oriX+25, oriY+70,WHITE,1.0); // erase old digital values
NOBOLD g_printString(" ANALOGS ",oriX+25, oriY+140,TEAL,1.0);
for(i=0;i<8;i++){
digitals[2*i]=48+digital(i);
}
NOBOLD g_printString(digitals,oriX+25, oriY+70,BLACK,1.0); // write new digital values
NOBOLD g_printString(buttons,oriX+30, oriY+120,WHITE,1.0); // erase old button values
buttons[0]=48+!!left_button();
buttons[2]=48+!!up_button();
buttons[4]=48+!!down_button();
buttons[6]=48+!!right_button();
buttons[8]=48+!!a_button();
buttons[10]=48+!!b_button();
_bob.button=!!kiss_get_key('.');
buttons[12]=48+black_button();
NOBOLD g_printString(buttons,oriX+30, oriY+120,BLACK,1.0); // erase old button values
for(i=8;i<16;i++){//print out analogs
analogs[i-8][1]=(i<10)?48+i:48+i-10;
analogs[i-8][0]=(i<10)?32:49;
analogs[i-8][2]=':';
analogs[i-8][3]=' ';
NOBOLD g_printString(analogs[i-8],oriX+5, oriY+155+(15*(i-8)),WHITE,1.0);
convertNumToString(analog10(i),4,*analogs,10,i-8,3);
graphics_rectangle_fill(oriX+30,oriY+155+(15*(i-8)),oriX+157, oriY+165+(15*(i-8)),GRAY);
graphics_line(oriX+30+analog(i)/2, oriY+155+(15*(i-8)),oriX+30+analog(i)/2,oriY+165+(15*(i-8)),RED);
NOBOLD g_printString(analogs[i-8],oriX+5, oriY+155+(15*(i-8)),BLACK,1.0);
}
analogs[8][1]='X';
analogs[8][0]='A';
analogs[8][2]=':';
analogs[8][3]=' ';
NOBOLD g_printString(analogs[8],oriX+5, oriY+155+(15*(8)),WHITE,1.0);
convertNumToString(accel_x(),5,*analogs,10,8,3);
graphics_rectangle_fill(oriX+30,oriY+155+(15*(8)),oriX+157, oriY+165+(15*(8)),GRAY);
graphics_line(oriX+30+(accel_x()+2048)/32, oriY+155+(15*(8)),oriX+30+(accel_x()+2048)/32,oriY+165+(15*(8)),RED);
NOBOLD g_printString(analogs[8],oriX+5, oriY+155+(15*(8)),BLACK,1.0);
analogs[9][1]='Y';
analogs[9][0]='A';
analogs[9][2]=':';
analogs[9][3]=' ';
NOBOLD g_printString(analogs[9],oriX+5, oriY+155+(15*(9)),WHITE,1.0);
convertNumToString(accel_y(),5,*analogs,10,9,3);
graphics_rectangle_fill(oriX+30,oriY+155+(15*(9)),oriX+157, oriY+165+(15*(9)),GRAY);
graphics_line(oriX+30+(accel_y()+2048)/32, oriY+155+(15*(9)),oriX+30+(accel_y()+2048)/32,oriY+165+(15*(9)),RED);
NOBOLD g_printString(analogs[9],oriX+5, oriY+155+(15*(9)),BLACK,1.0);
analogs[10][1]='Z';
analogs[10][0]='A';
analogs[10][2]=':';
analogs[10][3]=' ';
NOBOLD g_printString(analogs[10],oriX+5, oriY+155+(15*(10)),WHITE,1.0);
convertNumToString(accel_z(),5,*analogs,10,10,3);
graphics_rectangle_fill(oriX+30,oriY+155+(15*(10)),oriX+157, oriY+165+(15*(10)),GRAY);
graphics_line(oriX+30+(accel_z()+2048)/32, oriY+155+(15*(10)),oriX+30+(accel_z()+2048)/32,oriY+165+(15*(10)),RED);
NOBOLD g_printString(analogs[10],oriX+5, oriY+155+(15*(10)),BLACK,1.0);
NOBOLD g_printString("MOT PWM TPS ENCODER VAL",oriX+5, oriY+330,TEAL,1.0);
for(i=0;i<4;i++){
actuators[i][0]=48+i;
actuators[i][1]=':';
actuators[i][2]=' ';
NOBOLD g_printString(actuators[i],oriX+5, oriY+345+(15*(i)),WHITE,1.0);
convertNumToString(_bob.motor_pwm[i],4,*actuators,25,i,2);
convertNumToString(_bob.motor_tps[i],4,*actuators,25,i,7);
convertNumToString(_bob.motor_counter[i],10,*actuators,25,i,12);
NOBOLD g_printString(actuators[i],oriX+5, oriY+345+(15*(i)),BLACK,1.0);
}
if(_bob.enable_servos){
NOBOLD g_printString("SERVO TARGET DISABLED",oriX+5, oriY+410,WHITE,1.0);
NOBOLD g_printString("SERVO TARGET ENABLED",oriX+5, oriY+410,TEAL,1.0);
}
else {
NOBOLD g_printString("SERVO TARGET ENABLED",oriX+5, oriY+410,WHITE,1.0);
NOBOLD g_printString("SERVO TARGET DISABLED",oriX+5, oriY+410,TEAL,1.0);
}
for(i=0;i<4;i++){
servos[i][2]=49+i;//servos are 1 indexed!!
servos[i][3]=':';
servos[i][4]=' ';
NOBOLD g_printString(servos[i],oriX+5, oriY+425+(15*(i)),WHITE,1.0);
convertNumToString(_bob.servo_targets[i],4,*servos,25,i,6);
NOBOLD g_printString(servos[i],oriX+5, oriY+425+(15*(i)),BLACK,1.0);
}
}
