Subversion Repositories svnkaklik

Rev

Rev 150 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log

Rev 150 Rev 152
1 
#include ".\camerus.h"
 1 
#include ".\camerus.h"
2 
 
 2 
 
3 
#USE FAST_IO (C)
 3 
#USE FAST_IO (C)
4 
 
 4 
 
5 
// kroutitka
 5 
// kroutitka
6 
#define  CERVENA  1  // AN1
 6 
#define  CERVENA  1  // AN1
7 
#define  CERNA    4  // AN4
 7 
#define  CERNA    4  // AN4
8 
#define  ZELENA   3  // AN3
 8 
#define  ZELENA   3  // AN3
9 
#define  MODRA    0  // AN0
 9 
#define  MODRA    0  // AN0
10 
 
 10 
 
11 
// I/O
 11 
// I/O
12 
#define LED    PIN_C0
 12 
#define LED    PIN_C0
13 
#define HREF   PIN_C5
 13 
#define HREF   PIN_C5
14 
#define PIX    PIN_C6
 14 
#define PIX    PIN_C6
15 
#define SERVO  PIN_B7
 15 
#define SERVO  PIN_B7
16 
 
 16 
 
17 
void main()
 17 
void main()
18 
{
 18 
{
19 
   int8 cas;
 19 
   int8 cas;
20 
   int16 offset;
 20 
   int16 offset;
21 
 
 21 
 
22 
   setup_adc_ports(ALL_ANALOG);
 22 
   setup_adc_ports(ALL_ANALOG);
23 
   setup_adc(ADC_CLOCK_INTERNAL);
 23 
   setup_adc(ADC_CLOCK_INTERNAL);
24 
   setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1);
 24 
   setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1);
25 
   setup_timer_1(T1_DISABLED);
 25 
   setup_timer_1(T1_DISABLED);
26 
   setup_timer_2(T2_DIV_BY_16,255,1);
 26 
   setup_timer_2(T2_DIV_BY_16,255,1);
27 
   setup_ccp1(CCP_PWM); // RC1
 27 
   setup_ccp1(CCP_PWM); // RC1
28 
   setup_ccp2(CCP_PWM); // RC2
 28 
   setup_ccp2(CCP_PWM); // RC2
29 
   setup_comparator(NC_NC_NC_NC);
 29 
   setup_comparator(NC_NC_NC_NC);
30 
   setup_vref(FALSE);
 30 
   setup_vref(FALSE);
31 
 
 31 
 
32 
   set_tris_c(0b11111000);
 32 
   set_tris_c(0b11111000);
33 
 
 33 
 
34 
   output_high(LED);
 34 
   output_high(LED);
35 
 
 35 
 
- 
 
 36 
   delay_ms(200);
- 
 
 37 
 
36 
   i2c_start();      // Reset
 38 
   i2c_start();      // Reset
37 
   i2c_write(0xC0);
 39 
   i2c_write(0xC0);
38 
   i2c_write(0x12);
 40 
   i2c_write(0x12);
39 
   i2c_write(0x80 | 0x24);
 41 
   i2c_write(0x80 | 0x24);
40 
   i2c_stop();
 42 
   i2c_stop();
41 
 
 43 
 
42 
   i2c_start();      // BW
 44 
   i2c_start();      // BW
43 
   i2c_write(0xC0);
 45 
   i2c_write(0xC0);
44 
   i2c_write(0x28);
 46 
   i2c_write(0x28);
45 
   i2c_write(0b01000001);
 47 
   i2c_write(0b01000001);
46 
   i2c_stop();
 48 
   i2c_stop();
47 
 
 49 
 
- 
 
 50 
 
48 
   i2c_start();      // Contrast
 51 
   i2c_start();      // Contrast
49 
   i2c_write(0xC0);
 52 
   i2c_write(0xC0);
50 
   i2c_write(0x05);
 53 
   i2c_write(0x05);
51 
   i2c_write(0xFF);
 54 
   i2c_write(0xA0);
52 
   i2c_stop();
 55 
   i2c_stop();
- 
 
 56 
/*
53 
 
 57 
 
54 
   i2c_start();      // Brightness
 58 
   i2c_start();      // Brightness
55 
   i2c_write(0xC0);
 59 
   i2c_write(0xC0);
56 
   i2c_write(0x06);
 60 
   i2c_write(0x06);
57 
   i2c_write(0x80);
 61 
   i2c_write(0x80);
58 
   i2c_stop();
 62 
   i2c_stop();
59 
 
 63 
 
60 
/*
 - 
 
61 
   i2c_start();      // Band Filter
 64 
   i2c_start();      // Band Filter
62 
   i2c_write(0xC0);
 65 
   i2c_write(0xC0);
63 
   i2c_write(0x2D);
 66 
   i2c_write(0x2D);
64 
   i2c_write(0x04 | 0x03);
 67 
   i2c_write(0x04 | 0x03);
65 
   i2c_stop();
 68 
   i2c_stop();
66 
 
 69 
 
67 
   i2c_start();      // 4-bit, (CLK/4)
 70 
   i2c_start();      // 4-bit, (CLK/4)
68 
   i2c_write(0xC0);
 71 
   i2c_write(0xC0);
69 
   i2c_write(0x3E);
 72 
   i2c_write(0x3E);
70 
   i2c_write(0x10 | 0x80);
 73 
   i2c_write(0x10 | 0x80);
71 
   i2c_stop();
 74 
   i2c_stop();
72 
*/
 75 
*/
73 
   i2c_start();      // VSTRT
 76 
   i2c_start();      // VSTRT
74 
   i2c_write(0xC0);
 77 
   i2c_write(0xC0);
75 
   i2c_write(0x19);
 78 
   i2c_write(0x19);
76 
   i2c_write(45);
 79 
   i2c_write(45);
77 
   i2c_stop();
 80 
   i2c_stop();
78 
 
 81 
 
79 
   i2c_start();      // VEND
 82 
   i2c_start();      // VEND
80 
   i2c_write(0xC0);
 83 
   i2c_write(0xC0);
81 
   i2c_write(0x1A);
 84 
   i2c_write(0x1A);
82 
   i2c_write(45);
 85 
   i2c_write(45);
83 
   i2c_stop();
 86 
   i2c_stop();
84 
 
 87 
 
85 
   output_low(LED);
 88 
   output_low(LED);
- 
 
 89 
   delay_ms(100);
- 
 
 90 
 
86
91 
/*
- 
 
 92 
   i2c_start();      // BW + freeze AGC/AEC
- 
 
 93 
   i2c_write(0xC0);
- 
 
 94 
   i2c_write(0x28);
- 
 
 95 
   i2c_write(0b01010001);
- 
 
 96 
   i2c_stop();
- 
 
 97 
*/
- 
 
 98 
   output_high(LED);
- 
 
 99 
   delay_ms(100);
- 
 
 100 
   output_low(LED);
- 
 
 101 
 
87 
   cas=128;
 102 
   cas=128;
88 
 
 103 
 
89 
   while(true)
 104 
   while(true)
90 
   {
 105 
   {
91 
      while(!input(HREF));
 106 
      while(!input(HREF));
- 
 
 107 
//      delay_cycles(4);
92 
      set_timer0(0);
 108 
      set_timer0(0);
93 
      while(input(HREF))
 109 
      while(input(HREF))
94 
      {
 110 
      {
- 
 
 111 
         if(!input(PIX))
95 
        if(!input(PIX))
 112 
         if(!input(PIX))
96 
        {
 113 
         {
97 
          cas=get_timer0();
 114 
            cas=get_timer0();
- 
 
 115 
            cas=255-cas;
98 
          break;
 116 
            break;
99 
        }
 117 
         };
100 
      };
 118 
      };
101 
 
 119 
 
102 
      cas=255-cas;
 - 
 
103
- 
 
104 
      set_adc_channel(MODRA);
 120 
      set_adc_channel(MODRA);
105 
      Delay_ms(1);
 121 
      Delay_ms(1);
106 
      offset=read_adc();
 122 
      offset=read_adc();
107 
      output_high(SERVO);
 123 
      output_high(SERVO);
108 
      delay_us(900);
 124 
      delay_us(1000);
- 
 
 125 
      delay_us(offset);
109 
      delay_us(offset);
 126 
      delay_us(offset);
110 
      delay_us(cas);
 127 
      delay_us(cas);
111 
      delay_us(cas);
 128 
      delay_us(cas);
112 
      delay_us(cas);
 129 
//      delay_us(cas);
113 
      output_LOW(SERVO);
 130 
      output_low(SERVO);
114 
      set_pwm1_duty(cas);
 131 
      set_pwm1_duty(cas);
115 
      set_pwm2_duty(255-cas);
 132 
      set_pwm2_duty(255-cas);
116 
   };
 133 
   };
117 
}
 134 
}