Paparazzi UAS  v5.0.5_stable-7-g4b8bbb7
Paparazzi is a free software Unmanned Aircraft System.
 All Data Structures Files Functions Variables Typedefs Enumerations Enumerator Macros Modules Pages
servos_4015_MAT_hw.c
Go to the documentation of this file.
1 /*
2  * Copyright (C) 2006 Antoine Drouin
3  *
4  * This file is part of paparazzi.
5  *
6  * paparazzi is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2, or (at your option)
9  * any later version.
10  *
11  * paparazzi is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with paparazzi; see the file COPYING. If not, write to
18  * the Free Software Foundation, 59 Temple Place - Suite 330,
19  * Boston, MA 02111-1307, USA.
20  *
21  */
22 
28 #include "subsystems/actuators.h"
29 #include "paparazzi.h"
30 #include "generated/airframe.h"
31 
34 
35 #define START_TIMEOUT 0xFFFF;
36 
37 void actuators_4015_init ( void ) {
38  /* select clock pin as MAT0.1 output */
39  IO0DIR |= _BV(SERVO_CLOCK_PIN);
41 
42  /* select reset pin as GPIO output */
43  IO1DIR |= _BV(SERVO_RESET_PIN);
44  PINSEL2 &= ~(_BV(3)); /* P1.25-16 are used as GPIO */
45  /* assert RESET */
46  IO1SET = _BV(SERVO_RESET_PIN);
47 
48  /* DATA pin output */
49  IO1DIR |= _BV(SERVO_DATA_PIN);
50 
51  /* enable match 1 interrupt */
52  T0MCR |= TMCR_MR1_I;
53 
54  /* lower clock */
55  T0EMR &= ~TEMR_EM1;
56  /* set high on match 1 */
57  T0EMR |= TEMR_EMC1_2;
58 
59  /* set first pulse in a while */
62  /* Set all servos at their midpoints */
63  /* compulsory for unaffected servos */
64  uint8_t i;
65  for( i=0 ; i < _4015_NB_CHANNELS ; i++ )
67 
69 }
70 
71 
73 
unsigned short uint16_t
Definition: types.h:16
#define IO1SET
Definition: LPC21xx.h:338
#define SERVO_CLOCK_PINSEL
Definition: hb_1.1.h:56
#define SERVOS_TICS_OF_USEC(s)
#define SERVO_CLOCK_PINSEL_BIT
Definition: hb_1.1.h:58
#define T0MCR
Definition: LPC21xx.h:55
uint32_t servos_delay
#define TMCR_MR1_I
Definition: lpcTMR.h:62
#define SERVO_CLOCK_PIN
Definition: hb_1.1.h:55
#define _4015_NB_CHANNELS
#define SERVO_DATA_PIN
Definition: tiny_0.99.h:50
void actuators_4015_init(void)
unsigned long uint32_t
Definition: types.h:18
Hardware independent API for actuators (servos, motor controllers).
#define T0EMR
Definition: LPC21xx.h:65
#define T0MR1
Definition: LPC21xx.h:57
#define IO0DIR
Definition: LPC21xx.h:335
uint8_t servos_4015_idx
#define SERVO_REFRESH_TICS
unsigned char uint8_t
Definition: types.h:14
uint16_t servos_values[_4015_NB_CHANNELS]
#define PINSEL2
Definition: LPC21xx.h:349
#define TEMR_EMC1_2
Definition: lpcTMR.h:159
#define TEMR_EM1
Definition: lpcTMR.h:150
#define SERVO_RESET_PIN
Definition: hb_1.1.h:60
#define SERVO_CLOCK_PINSEL_VAL
Definition: hb_1.1.h:57
#define START_TIMEOUT
#define IO1DIR
Definition: LPC21xx.h:339