This program is for an autonomous robot for the competition at the Hochschule Luzern. http://cruisingcrepe.wordpress.com/ We are one of the 32 teams. http://cruisingcrepe.wordpress.com/ The postition control is based on this Documentation: Control of Wheeled Mobile Robots: An Experimental Overview from Alessandro De Luca, Giuseppe Oriolo, Marilena Vendittelli. For more information see here: http://www.dis.uniroma1.it/~labrob/pub/papers/Ramsete01.pdf

Dependencies:   mbed

Fork of autonomous Robot Android by Christian Burri

Committer:
chrigelburri
Date:
Sun Mar 03 16:26:47 2013 +0000
Revision:
2:d8e1613dc38b
Parent:
1:6cd533a712c6
Viereck Fahren; Code aufger?umt und eine setter methode progammiert f?r sollwert

Who changed what in which revision?

UserRevisionLine numberNew contents of line
chrigelburri 0:31f7be68e52d 1 #ifndef _MAXON_ESCON_H_
chrigelburri 0:31f7be68e52d 2 #define _MAXON_ESCON_H_
chrigelburri 0:31f7be68e52d 3
chrigelburri 0:31f7be68e52d 4 #include "mbed.h"
chrigelburri 0:31f7be68e52d 5 #include "Hallsensor.h"
chrigelburri 0:31f7be68e52d 6 #include "defines.h"
chrigelburri 0:31f7be68e52d 7
chrigelburri 0:31f7be68e52d 8 /**
chrigelburri 0:31f7be68e52d 9 * @author Christian Burri
chrigelburri 0:31f7be68e52d 10 *
chrigelburri 0:31f7be68e52d 11 * @section LICENSE
chrigelburri 0:31f7be68e52d 12 *
chrigelburri 1:6cd533a712c6 13 * Copyright © 2013 HSLU Pren Team #1 Cruising Crêpe
chrigelburri 0:31f7be68e52d 14 * All rights reserved.
chrigelburri 0:31f7be68e52d 15 *
chrigelburri 0:31f7be68e52d 16 * @section DESCRIPTION
chrigelburri 0:31f7be68e52d 17 *
chrigelburri 0:31f7be68e52d 18 * This class implements the driver for the Maxon ESCON servo driver.....
chrigelburri 0:31f7be68e52d 19 *
chrigelburri 0:31f7be68e52d 20 * Datasheet:
chrigelburri 0:31f7be68e52d 21 *
chrigelburri 0:31f7be68e52d 22 * http://escon.maxonmotor.com
chrigelburri 0:31f7be68e52d 23 */
chrigelburri 0:31f7be68e52d 24 class MaxonESCON
chrigelburri 0:31f7be68e52d 25 {
chrigelburri 0:31f7be68e52d 26
chrigelburri 2:d8e1613dc38b 27 private:
chrigelburri 0:31f7be68e52d 28
chrigelburri 2:d8e1613dc38b 29 /** To Enable the amplifier */
chrigelburri 2:d8e1613dc38b 30 DigitalOut _enb;
chrigelburri 0:31f7be68e52d 31 /** Duty Cycle to set the speed */
chrigelburri 0:31f7be68e52d 32 PwmOut _pwm;
chrigelburri 0:31f7be68e52d 33 /** Hallsensor Class */
chrigelburri 0:31f7be68e52d 34 Hallsensor* _hall;
chrigelburri 0:31f7be68e52d 35 /** Ready output from ESCON */
chrigelburri 0:31f7be68e52d 36 DigitalIn _isenb;
chrigelburri 0:31f7be68e52d 37 /** Actual speed from ESCON analog Output 1 */
chrigelburri 0:31f7be68e52d 38 AnalogIn _actualSpeed;
chrigelburri 0:31f7be68e52d 39 /** increment the Hallpattern */
chrigelburri 0:31f7be68e52d 40 int _pulses;
chrigelburri 0:31f7be68e52d 41
chrigelburri 0:31f7be68e52d 42 public:
chrigelburri 0:31f7be68e52d 43
chrigelburri 0:31f7be68e52d 44 /** Create a motor control object
chrigelburri 0:31f7be68e52d 45 *
chrigelburri 0:31f7be68e52d 46 * @param enb DigitalOut, set high for enable
chrigelburri 0:31f7be68e52d 47 * @param isenb DigitalIn, high for enable
chrigelburri 0:31f7be68e52d 48 * @param pwm PwmOut pin, set the Velocity
chrigelburri 1:6cd533a712c6 49 * @param hall HALL Object
chrigelburri 1:6cd533a712c6 50 * @param actualSpeed AnalogIn Filtered Signal for ActualSpeed from Motor
chrigelburri 1:6cd533a712c6 51 * @param hall The Object of the Hallsensor from Motor
chrigelburri 0:31f7be68e52d 52 */
chrigelburri 0:31f7be68e52d 53 MaxonESCON(PinName enb,
chrigelburri 0:31f7be68e52d 54 PinName isenb,
chrigelburri 0:31f7be68e52d 55 PinName pwm,
chrigelburri 0:31f7be68e52d 56 PinName actualSpeed,
chrigelburri 0:31f7be68e52d 57 Hallsensor *hall);
chrigelburri 0:31f7be68e52d 58
chrigelburri 0:31f7be68e52d 59 /** Set the speed of the motor with a pwm for 10%..90%
chrigelburri 0:31f7be68e52d 60 * 50% PWM is 0rpm
chrigelburri 1:6cd533a712c6 61 * Caclulate from [1/s] in [1/min] and the Factor of the ESCON
chrigelburri 0:31f7be68e52d 62 * @param speed The speed of the motor as a normalised value in [1/s]
chrigelburri 0:31f7be68e52d 63 */
chrigelburri 0:31f7be68e52d 64 void setVelocity(float speed);
chrigelburri 0:31f7be68e52d 65
chrigelburri 0:31f7be68e52d 66 /**Return the speed from ESCON
chrigelburri 0:31f7be68e52d 67 *
chrigelburri 0:31f7be68e52d 68 * Analog input 1.65V = 0 rpm
chrigelburri 0:31f7be68e52d 69 *
chrigelburri 0:31f7be68e52d 70 * @return speed of the motor [1/s]
chrigelburri 0:31f7be68e52d 71 */
chrigelburri 0:31f7be68e52d 72 float getActualSpeed(void);
chrigelburri 0:31f7be68e52d 73
chrigelburri 0:31f7be68e52d 74 /** Set the period of the pwm duty cycle.
chrigelburri 0:31f7be68e52d 75 *
chrigelburri 0:31f7be68e52d 76 * Wrapper for PwmOut::period()
chrigelburri 0:31f7be68e52d 77 *
chrigelburri 1:6cd533a712c6 78 * @param period Pwm duty cycle in seconds.
chrigelburri 0:31f7be68e52d 79 */
chrigelburri 0:31f7be68e52d 80 void period(float period);
chrigelburri 0:31f7be68e52d 81
chrigelburri 0:31f7be68e52d 82 /** Set the Motor to a enable sate
chrigelburri 0:31f7be68e52d 83 *
chrigelburri 1:6cd533a712c6 84 * @param enb <code>0</code> for disable <code>1</code> for enable.
chrigelburri 0:31f7be68e52d 85 */
chrigelburri 0:31f7be68e52d 86 void enable (bool enb);
chrigelburri 0:31f7be68e52d 87
chrigelburri 0:31f7be68e52d 88 /**Tests if the servo drive is enabled.
chrigelburri 0:31f7be68e52d 89 *
chrigelburri 0:31f7be68e52d 90 * @return <code>true</code> if the drive is enabled, <code>false</code> otherwise.
chrigelburri 0:31f7be68e52d 91 */
chrigelburri 0:31f7be68e52d 92 bool isEnabled(void);
chrigelburri 0:31f7be68e52d 93
chrigelburri 0:31f7be68e52d 94 /** Return the translativ Position
chrigelburri 0:31f7be68e52d 95 *
chrigelburri 0:31f7be68e52d 96 * @return position in meter
chrigelburri 0:31f7be68e52d 97 */
chrigelburri 0:31f7be68e52d 98 int getPulses(void);
chrigelburri 0:31f7be68e52d 99
chrigelburri 0:31f7be68e52d 100 /** Set the Pulses of the Motor
chrigelburri 0:31f7be68e52d 101 *
chrigelburri 0:31f7be68e52d 102 * @return number of turns
chrigelburri 0:31f7be68e52d 103 */
chrigelburri 0:31f7be68e52d 104 int setPulses(int setPos);
chrigelburri 0:31f7be68e52d 105 };
chrigelburri 0:31f7be68e52d 106
chrigelburri 0:31f7be68e52d 107 #endif