Paparazzi UAS  v5.18.0_stable
Paparazzi is a free software Unmanned Aircraft System.
servos_4017_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 #include "subsystems/actuators.h"
23 
24 #include "paparazzi.h"
25 #include "generated/airframe.h"
26 
28 
29 #define START_TIMEOUT 0xFFFF;
30 
32 {
33  /* select clock pin as MAT0.1 output */
34  IO0DIR |= _BV(SERVO_CLOCK_PIN);
36 
37  /* select reset pin as GPIO output */
38  IO1DIR |= _BV(SERVO_RESET_PIN);
39  PINSEL2 &= ~(_BV(3)); /* P1.25-16 are used as GPIO */
40  // SERVO_RESET_PINSEL |= SERVO_RESET_PINSEL_VAL << SERVO_RESET_PINSEL_BIT;
41  /* assert RESET */
42  IO1SET = _BV(SERVO_RESET_PIN);
43 
44  /* enable match 1 interrupt */
45  T0MCR |= TMCR_MR1_I;
46 
47 #ifndef SERVOS_4017_CLOCK_FALLING
48  /* lower clock */
49  T0EMR &= ~TEMR_EM1;
50  /* set high on match 1 */
51  T0EMR |= TEMR_EMC1_2;
52 #else
53  /* assert clock */
54  T0EMR |= TEMR_EM1;
55  /* set low on match 1 */
56  T0EMR |= TEMR_EMC1_1;
57 #endif
58  /* set first pulse in a while */
61  /* Set all servos at their midpoints */
62  /* compulsory for unaffected servos */
63  uint8_t i;
64  for (i = 0 ; i < _4017_NB_CHANNELS ; i++) {
66  }
67 #ifdef SERVO_MOTOR
68  servos_values[SERVO_MOTOR] = SERVOS_TICS_OF_USEC(SERVO_MOTOR_NEUTRAL);
69 #endif
70 #ifdef SERVO_MOTOR_LEFT
71  servos_values[SERVO_MOTOR_LEFT] = SERVOS_TICS_OF_USEC(SERVO_MOTOR_LEFT_NEUTRAL);
72 #endif
73 #ifdef SERVO_MOTOR_RIGHT
74  servos_values[SERVO_MOTOR_RIGHT] = SERVOS_TICS_OF_USEC(SERVO_MOTOR_RIGHT_NEUTRAL);
75 #endif
76 #ifdef SERVO_HATCH
77  servos_values[SERVO_HATCH] = SERVOS_TICS_OF_USEC(SERVO_HATCH_NEUTRAL);
78 #endif
79 }
80 
81 
83 
uint16_t
unsigned short uint16_t
Definition: types.h:16
T0MCR
#define T0MCR
Definition: LPC21xx.h:55
actuators_4017_init
void actuators_4017_init(void)
Definition: servos_4017_hw.c:31
paparazzi.h
servos_4017_idx
uint8_t servos_4017_idx
Definition: servos_4017_hw.c:27
SERVO_RESET_PIN
#define SERVO_RESET_PIN
Definition: hb_1.1.h:34
TEMR_EMC1_2
#define TEMR_EMC1_2
Definition: lpcTMR.h:159
TMCR_MR1_I
#define TMCR_MR1_I
Definition: lpcTMR.h:62
T0MR1
#define T0MR1
Definition: LPC21xx.h:57
SERVO_CLOCK_PINSEL
#define SERVO_CLOCK_PINSEL
Definition: hb_1.1.h:30
servos_values
uint16_t servos_values[_4017_NB_CHANNELS]
Definition: servos_4017_hw.c:82
SERVOS_TICS_OF_USEC
#define SERVOS_TICS_OF_USEC(s)
Definition: actuators_pwm_arch.h:41
SERVO_CLOCK_PINSEL_VAL
#define SERVO_CLOCK_PINSEL_VAL
Definition: hb_1.1.h:31
TEMR_EM1
#define TEMR_EM1
Definition: lpcTMR.h:150
SERVO_CLOCK_PINSEL_BIT
#define SERVO_CLOCK_PINSEL_BIT
Definition: hb_1.1.h:32
uint8_t
unsigned char uint8_t
Definition: types.h:14
SERVO_CLOCK_PIN
#define SERVO_CLOCK_PIN
Definition: hb_1.1.h:29
TEMR_EMC1_1
#define TEMR_EMC1_1
Definition: lpcTMR.h:158
START_TIMEOUT
#define START_TIMEOUT
Definition: servos_4017_hw.c:29
IO0DIR
#define IO0DIR
Definition: LPC21xx.h:335
T0EMR
#define T0EMR
Definition: LPC21xx.h:65
PINSEL2
#define PINSEL2
Definition: LPC21xx.h:349
_4017_NB_CHANNELS
#define _4017_NB_CHANNELS
Definition: servos_4017_hw.h:40
IO1SET
#define IO1SET
Definition: LPC21xx.h:338
IO1DIR
#define IO1DIR
Definition: LPC21xx.h:339
actuators.h