Subversion Repositories svnkaklik

Rev

Rev 373 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log

Rev 373 Rev 374
Line 39... Line 39...
39
#define CMPS_Addr   0x60    // 0xC0
39
#define CMPS_Addr   0x60    // 0xC0
40
#define M1	0x50 // 0xA0 in fact
40
#define M1	0x50 // 0xA0 in fact
41
#define M2	0x51 // 0xA2 in fact
41
#define M2	0x51 // 0xA2 in fact
42
 
42
 
43
 
43
 
44
char vystup[50];
-
 
45
pthread_t thread_1, thread_2, thread_3;
-
 
46
FILE *pRouraO,*pRouraI;
-
 
47
unsigned int vzdalenost;
-
 
48
char command,ble;
-
 
49
int param;
-
 
50
int file;
44
int file;
51
double nord, east;
-
 
52
int done; // vlajka, ze se neco udelalo
-
 
53
int last_cross; // posledni krizovatka
-
 
54
 
-
 
55
 
45
 
56
void I2C_addr (int Addr)
46
void I2C_addr (int Addr)
57
{
47
{
58
    if (ioctl(file, I2C_SLAVE, Addr) == -1)
48
    if (ioctl(file, I2C_SLAVE, Addr) == -1)
59
    {
49
    {
Line 111... Line 101...
111
int main(int argc, char *argv[], char *envp[])
101
int main(int argc, char *argv[], char *envp[])
112
{
102
{
113
    unsigned int OldAddress, NewAddress;
103
    unsigned int OldAddress, NewAddress;
114
    char Buf[10];
104
    char Buf[10];
115
 
105
 
116
	fprintf(stdout, "\n **** Changing I2C Address **** \n \r");
106
	fprintf(stdout, "\n **** Change I2C Address **** \n \r");
-
 
107
 
-
 
108
    if (argc<2)
-
 
109
    {
-
 
110
        printf("Use:\n%s OldAddress NewAddress - for change address\nOR\n%s Address - for echo\n\r",argv[0],argv[0]);
-
 
111
        return 0;
-
 
112
    }
117
 
113
 
118
    i2c_init();
114
    i2c_init();
119
 
115
 
-
 
116
    sscanf(argv[1],"%x",&OldAddress);
-
 
117
 
120
    if ( argc < 3 )
118
    if (argc==2)
121
    {
119
    {
-
 
120
        echo(OldAddress);
122
        printf("Use:\n%s OldAddress NewAddress\n",argv[0]);
121
        printf("Vzdalenost: %d\n", echo(NewAddress));
-
 
122
        close(file);
123
        return 0;
123
        return 0;
124
    }
124
    }
125
 
125
 
126
    sscanf(argv[1],"%x",&OldAddress);
-
 
127
    sscanf(argv[2],"%x",&NewAddress);
126
    sscanf(argv[2],"%x",&NewAddress);
128
 
127
 
129
    printf("Old: %x New: %x\n", OldAddress, NewAddress);
128
    printf("Old: %x New: %x\n", OldAddress, NewAddress);
130
 
129
 
131
    echo(OldAddress);
130
    echo(OldAddress);