Subversion Repositories svnkaklik

Rev

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

Rev 226 Rev 228
Line 1... Line 1...
1 
//********* Robot Camerus pro IstRobot 2007 ************
 1 
//********* Robot Camerus pro IstRobot 2007 ************
2 
//"$Id: camerus.c 226 2007-04-08 08:03:04Z kakl $"
 2 
//"$Id: camerus.c 228 2007-04-08 21:36:13Z kakl $"
3 
//*****************************************************
 3 
//*****************************************************
4 
 
 4 
 
5 
#include ".\camerus.h"
 5 
#include ".\camerus.h"
6 
 
 6 
 
7 
#USE FAST_IO (C)     // Brana C je ve FAST_IO modu, aby slo rychle cist z kamery
 7 
#USE FAST_IO (C)     // Brana C je ve FAST_IO modu, aby slo rychle cist z kamery
Line 218... Line 218...
218 
   output_low(IRTX);   // Zapni LED na detekci prekazky
 218 
   output_low(IRTX);   // Zapni LED na detekci prekazky
219 
 
 219 
 
220 
   NightRider(1);    // Aby se poznalo, ze byl RESET
 220 
   NightRider(1);    // Aby se poznalo, ze byl RESET
221 
                     // taky se musi pockat, nez se rozjede kamera, nez se do ni zacnou posilat prikazy
 221 
                     // taky se musi pockat, nez se rozjede kamera, nez se do ni zacnou posilat prikazy
222 
 
 222 
 
- 
 
 223 
   //... Nastaveni sonaru ...
- 
 
 224 
   i2c_start();
- 
 
 225 
   i2c_write(0xE0);
- 
 
 226 
   i2c_write(0x02);  // dosah
- 
 
 227 
   i2c_write(0x02);  // 86mm
- 
 
 228 
   i2c_stop();
- 
 
 229 
   i2c_start();
- 
 
 230 
   i2c_write(0xE0);
- 
 
 231 
   i2c_write(0x01);  // zesileni
- 
 
 232 
   i2c_write(0x00);
- 
 
 233 
   i2c_stop();
- 
 
 234 
 
223 
   //... Nastaveni kamery ...
 235 
   //... Nastaveni kamery ...
224 
   i2c_start();      // Soft RESET kamery
 236 
   i2c_start();      // Soft RESET kamery
225 
   i2c_write(0xC0);        // Pro single slave musi mit vsechny zapisy adresu C0h
 237 
   i2c_write(0xC0);        // Pro single slave musi mit vsechny zapisy adresu C0h
226 
   i2c_write(0x12);        // Adresa registru COMH
 238 
   i2c_write(0x12);        // Adresa registru COMH
227 
   i2c_write(0x80 | 0x24); // Zapis ridiciho slova
 239 
   i2c_write(0x80 | 0x24); // Zapis ridiciho slova