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();
}
}
int main()
{
X=0;
create_connect();
set_create_total_angle(0);
printf("X\tAngle");
cbc_display_clear();
printf("A to turn CCW 90deg.\tB to turn CW 90deg.\n");
printf("Left to turn CCW 45deg.\tRight to turn CW 45deg.\n");
printf("Down to force angle readjustment.\n");
while(black_button()==0)
{
if (a_button()==1)
{
turn(tspeed,45);
//turnHalfCCW();
printf("%d\t%d\n",X,get_create_total_angle(0.1));
}
if (b_button()==1)
{
turn(tspeed,-45);
//turnHalfCW();
printf("%d\t%d\n",X,get_create_total_angle(0.1));
}
if (left_button()==1)
{
turn(tspeed,90);
//turnCCW();
printf("%d\t%d\n",X,get_create_total_angle(0.1));
}
if (right_button() == 1)
{
turn(tspeed,-90);
//turnCW();
printf("%d\t%d\n",X,get_create_total_angle(0.1));
}
if (down_button() == 1)
{
turnAdjust();
printf("%d\t%d\n",X,get_create_total_angle(0.1));
}
}
}
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();
}
}
}
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);
}
}
