Christian Burri / Mbed 2 deprecated autonomousRobotAndroid

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

Fork of autonomousRobotAndroid by Christian Burri

Actuators/MaxonESCON.cpp@6:48eeb41188dd, 2013-03-23 (annotated)

Committer:
chrigelburri
Date:
Sat Mar 23 13:52:48 2013 +0000
Revision:
6:48eeb41188dd
Parent:
3:92ba0254af87
Child:
8:696c2f9dfc62
mit link und rechten Radradius

Who changed what in which revision?

UserRevisionLine numberNew contents of line
chrigelburri 0:31f7be68e52d 1 #include "MaxonESCON.h"
chrigelburri 0:31f7be68e52d 2
chrigelburri 0:31f7be68e52d 3 using namespace std;
chrigelburri 0:31f7be68e52d 4
chrigelburri 0:31f7be68e52d 5 MaxonESCON::MaxonESCON(
chrigelburri 0:31f7be68e52d 6 PinName enb,
chrigelburri 0:31f7be68e52d 7 PinName isenb,
chrigelburri 0:31f7be68e52d 8 PinName pwm,
chrigelburri 0:31f7be68e52d 9 PinName actualSpeed,
chrigelburri 0:31f7be68e52d 10 Hallsensor *hall
chrigelburri 0:31f7be68e52d 11 )
chrigelburri 0:31f7be68e52d 12 :
chrigelburri 0:31f7be68e52d 13 _enb(enb),
chrigelburri 0:31f7be68e52d 14 _isenb(isenb),
chrigelburri 0:31f7be68e52d 15 _pwm(pwm),
chrigelburri 0:31f7be68e52d 16 _actualSpeed(actualSpeed),
chrigelburri 0:31f7be68e52d 17 _hall(hall)
chrigelburri 0:31f7be68e52d 18 {
chrigelburri 0:31f7be68e52d 19
chrigelburri 0:31f7be68e52d 20 _pwm = 0;
chrigelburri 0:31f7be68e52d 21
chrigelburri 0:31f7be68e52d 22 // Initial condition of output enables
chrigelburri 0:31f7be68e52d 23 _enb = 0;
chrigelburri 0:31f7be68e52d 24
chrigelburri 0:31f7be68e52d 25 // Set initial condition of PWM 2kHz
chrigelburri 0:31f7be68e52d 26 period(0.0005);
chrigelburri 0:31f7be68e52d 27
chrigelburri 0:31f7be68e52d 28 // Set the pulses to zero
chrigelburri 0:31f7be68e52d 29 _pulses = 0;
chrigelburri 2:d8e1613dc38b 30
chrigelburri 0:31f7be68e52d 31 // Set the Pull Up Resistor
chrigelburri 0:31f7be68e52d 32 _isenb.mode(PullUp);
chrigelburri 0:31f7be68e52d 33 }
chrigelburri 0:31f7be68e52d 34
chrigelburri 0:31f7be68e52d 35 void MaxonESCON::setVelocity(float speed)
chrigelburri 0:31f7be68e52d 36 {
chrigelburri 0:31f7be68e52d 37 speed = speed / ESCON_SET_FACTOR * 60.0f;
chrigelburri 0:31f7be68e52d 38 if(speed > 1 ) {
chrigelburri 0:31f7be68e52d 39 _pwm = 0.9f;
chrigelburri 0:31f7be68e52d 40 } else if(speed < -1) {
chrigelburri 0:31f7be68e52d 41 _pwm = 0.1f;
chrigelburri 0:31f7be68e52d 42 } else {
chrigelburri 0:31f7be68e52d 43 _pwm = 0.4f*speed + 0.5f;
chrigelburri 0:31f7be68e52d 44 }
chrigelburri 0:31f7be68e52d 45 }
chrigelburri 0:31f7be68e52d 46
chrigelburri 0:31f7be68e52d 47 float MaxonESCON::getActualSpeed(void)
chrigelburri 0:31f7be68e52d 48 {
chrigelburri 0:31f7be68e52d 49 return (_actualSpeed.read()* 2.0f - 1.0f) * ESCON_GET_FACTOR / 60.0f;
chrigelburri 0:31f7be68e52d 50 }
chrigelburri 0:31f7be68e52d 51
chrigelburri 0:31f7be68e52d 52 void MaxonESCON::period(float period)
chrigelburri 0:31f7be68e52d 53 {
chrigelburri 0:31f7be68e52d 54 _pwm.period(period);
chrigelburri 0:31f7be68e52d 55 }
chrigelburri 0:31f7be68e52d 56
chrigelburri 0:31f7be68e52d 57 void MaxonESCON::enable(bool enb)
chrigelburri 0:31f7be68e52d 58 {
chrigelburri 6:48eeb41188dd 59 if(enb == true) {
chrigelburri 1:6cd533a712c6 60 _enb = 1;
chrigelburri 0:31f7be68e52d 61 } else {
chrigelburri 1:6cd533a712c6 62 _enb = 0;
chrigelburri 0:31f7be68e52d 63 }
chrigelburri 0:31f7be68e52d 64 }
chrigelburri 0:31f7be68e52d 65
chrigelburri 0:31f7be68e52d 66 bool MaxonESCON::isEnabled()
chrigelburri 0:31f7be68e52d 67 {
chrigelburri 0:31f7be68e52d 68 if(_isenb.read() == 1) {
chrigelburri 2:d8e1613dc38b 69 return true;
chrigelburri 2:d8e1613dc38b 70 } else {
chrigelburri 2:d8e1613dc38b 71 return false;
chrigelburri 2:d8e1613dc38b 72 }
chrigelburri 0:31f7be68e52d 73 }
chrigelburri 0:31f7be68e52d 74
chrigelburri 0:31f7be68e52d 75 int MaxonESCON::getPulses(void)
chrigelburri 0:31f7be68e52d 76 {
chrigelburri 0:31f7be68e52d 77 _pulses = _hall->getPulses();
chrigelburri 0:31f7be68e52d 78 return _pulses;
chrigelburri 0:31f7be68e52d 79 }
chrigelburri 0:31f7be68e52d 80
chrigelburri 0:31f7be68e52d 81 int MaxonESCON::setPulses(int setPos)
chrigelburri 0:31f7be68e52d 82 {
chrigelburri 0:31f7be68e52d 83 _hall->reset();
chrigelburri 0:31f7be68e52d 84 _pulses = _hall->getPulses();
chrigelburri 0:31f7be68e52d 85 return _pulses;
chrigelburri 0:31f7be68e52d 86 }