/elec/quadcopter

To get this branch, use:
bzr branch http://bzr.ed.am/elec/quadcopter

« back to all changes in this revision

Viewing changes to src/rc-interface/receiver.cc

  • Committer: Tim Marston
  • Date: 2014-01-08 22:38:10 UTC
  • Revision ID: tim@ed.am-20140108223810-o1mhgns6tath533c
added (unfinished) rc-interface module to src; added arduino.mk

Show diffs side-by-side

added added

removed removed

src/rc-interface/receiver.cc
5
5
 
6
6
#include "receiver.h"
7
7
#include "config.h"
8
 
#include "common.h"
9
8
#include <Arduino.h>
 
9
#include <limits.h>
10
10
 
11
11
 
12
12
// channel sequence order
55
55
}
56
56
 
57
57
 
58
 
bool Receiver::read_channels( int channel_values[] )
 
58
static unsigned long calculate_duration( unsigned long then, unsigned long now )
 
59
{
 
60
        return now - then;
 
61
        
 
62
        if( now < then )
 
63
                return now + ( ULONG_MAX - then );
 
64
        else
 
65
                return now - then;
 
66
}
 
67
 
 
68
 
 
69
bool Receiver::read_channels( unsigned long channel_values[] )
59
70
{
60
71
        static unsigned long last_pulse_down = 0;
61
72
        static int next_channel = 0;
93
104
                        {
94
105
                                // store channel value
95
106
                                int channel = channel_order_[ next_channel ] - 1;
96
 
                                channel_values[ channel ] = MAX_CHANNEL_VALUE *
97
 
                                        ( duration - MIN_PULSE_WIDTH ) /
98
 
                                        ( MAX_PULSE_WIDTH - MIN_PULSE_WIDTH );
 
107
                                channel_values[ channel ] = duration;
99
108
 
100
109
                                // we got a channel
101
110
                                next_channel++;