Jacob Katz / Mbed 2 deprecated SuperBall_Control2

moving to other mbed

main.cpp@0:7fbfec2a0cc0, 2012-04-17 (annotated)

Committer:
katzjacob
Date:
Tue Apr 17 23:38:51 2012 +0000
Revision:
0:7fbfec2a0cc0

        

        
Who changed what in which revision?

        

            
                
UserRevisionLine numberNew contents of line

            
            


katzjacob

0:7fbfec2a0cc0


     1

#include "mbed.h"





katzjacob

0:7fbfec2a0cc0


     2

#include "MODSERIAL.h"





katzjacob

0:7fbfec2a0cc0


     3







katzjacob

0:7fbfec2a0cc0


     4

//globals for stick inputs and led outputs





katzjacob

0:7fbfec2a0cc0


     5

AnalogIn topStickVert(p15);





katzjacob

0:7fbfec2a0cc0


     6

AnalogIn topStickHorz(p16);





katzjacob

0:7fbfec2a0cc0


     7

AnalogIn botStickVert(p17);





katzjacob

0:7fbfec2a0cc0


     8

AnalogIn botStickHorz(p18);





katzjacob

0:7fbfec2a0cc0


     9







katzjacob

0:7fbfec2a0cc0


    10

DigitalOut myled1(LED1);





katzjacob

0:7fbfec2a0cc0


    11

DigitalOut myled2(LED2);





katzjacob

0:7fbfec2a0cc0


    12

DigitalOut myled3(LED3);





katzjacob

0:7fbfec2a0cc0


    13

DigitalOut myled4(LED4);





katzjacob

0:7fbfec2a0cc0


    14







katzjacob

0:7fbfec2a0cc0


    15







katzjacob

0:7fbfec2a0cc0


    16

//xBee





katzjacob

0:7fbfec2a0cc0


    17

Serial pc(USBTX, USBRX); // tx, rx





katzjacob

0:7fbfec2a0cc0


    18

Serial xbee(p13, p14); //tx, rx





katzjacob

0:7fbfec2a0cc0


    19

DigitalOut rstXbee(p21);





katzjacob

0:7fbfec2a0cc0


    20







katzjacob

0:7fbfec2a0cc0


    21

/**





katzjacob

0:7fbfec2a0cc0


    22

* funtion to send data





katzjacob

0:7fbfec2a0cc0


    23

*/





katzjacob

0:7fbfec2a0cc0


    24

void xbeeSend(char data1, char data2)





katzjacob

0:7fbfec2a0cc0


    25

{





katzjacob

0:7fbfec2a0cc0


    26

        //send the preamble





katzjacob

0:7fbfec2a0cc0


    27

        xbee.putc(0xA1);





katzjacob

0:7fbfec2a0cc0


    28

        xbee.putc(0xB2);





katzjacob

0:7fbfec2a0cc0


    29

        //send the header





katzjacob

0:7fbfec2a0cc0


    30

        xbee.putc(0x02);





katzjacob

0:7fbfec2a0cc0


    31

        //send the data





katzjacob

0:7fbfec2a0cc0


    32

        xbee.putc(data1);





katzjacob

0:7fbfec2a0cc0


    33

        xbee.putc(data2);





katzjacob

0:7fbfec2a0cc0


    34

        //checksum?





katzjacob

0:7fbfec2a0cc0


    35







katzjacob

0:7fbfec2a0cc0


    36

    





katzjacob

0:7fbfec2a0cc0


    37

}





katzjacob

0:7fbfec2a0cc0


    38







katzjacob

0:7fbfec2a0cc0


    39

int main() {





katzjacob

0:7fbfec2a0cc0


    40







katzjacob

0:7fbfec2a0cc0


    41

    //reset the xbee





katzjacob

0:7fbfec2a0cc0


    42

    rstXbee = 0;





katzjacob

0:7fbfec2a0cc0


    43

    wait_ms(1); 





katzjacob

0:7fbfec2a0cc0


    44

    rstXbee=1;





katzjacob

0:7fbfec2a0cc0


    45

    wait_ms(1);





katzjacob

0:7fbfec2a0cc0


    46

    //LED verification





katzjacob

0:7fbfec2a0cc0


    47

    myled1 = 1;





katzjacob

0:7fbfec2a0cc0


    48

    wait(0.1);





katzjacob

0:7fbfec2a0cc0


    49

    myled2 = 1;





katzjacob

0:7fbfec2a0cc0


    50

    myled1 = 0;





katzjacob

0:7fbfec2a0cc0


    51

    wait(0.1);





katzjacob

0:7fbfec2a0cc0


    52

    myled2=0;





katzjacob

0:7fbfec2a0cc0


    53

    





katzjacob

0:7fbfec2a0cc0


    54

    //variables





katzjacob

0:7fbfec2a0cc0


    55

    int right;





katzjacob

0:7fbfec2a0cc0


    56

    int left;





katzjacob

0:7fbfec2a0cc0


    57

    





katzjacob

0:7fbfec2a0cc0


    58

    while(1) 





katzjacob

0:7fbfec2a0cc0


    59

    {





katzjacob

0:7fbfec2a0cc0


    60

    





katzjacob

0:7fbfec2a0cc0


    61

        pc.printf("READY!... ");





katzjacob

0:7fbfec2a0cc0


    62

        /*





katzjacob

0:7fbfec2a0cc0


    63

        pc.printf("Top VERT: %f    ", topStickVert.read());





katzjacob

0:7fbfec2a0cc0


    64

        pc.printf("Top HORZ: %f    ", topStickHorz.read());





katzjacob

0:7fbfec2a0cc0


    65

        pc.printf("Bot VERT: %f    ", botStickVert.read());





katzjacob

0:7fbfec2a0cc0


    66

        pc.printf("Bot HORZ: %f    \r\n", botStickHorz.read());*/





katzjacob

0:7fbfec2a0cc0


    67

        





katzjacob

0:7fbfec2a0cc0


    68

        int right = topStickVert.read()*256;





katzjacob

0:7fbfec2a0cc0


    69

        int left = botStickVert.read()*256;





katzjacob

0:7fbfec2a0cc0


    70

        xbeeSend(right, left);





katzjacob

0:7fbfec2a0cc0


    71

        





katzjacob

0:7fbfec2a0cc0


    72

        





katzjacob

0:7fbfec2a0cc0


    73

    }





katzjacob

0:7fbfec2a0cc0


    74

    





katzjacob

0:7fbfec2a0cc0


    75

}