Código Arduino

La placa Arduino recibe por puerto USB un comando de 3 bytes de longitud, donde el primer byte indica el comando, y los dos restantes están destinados a parámetros. Estos parámetros, al ser de tipo byte, contemplan un rango numérico del 0 al 255.

Hay 16 comandos disponibles. Los 11 primeros están relacionados con el movimiento de los motores (comandos 0 al 10). El comando 11 está destinado al zumbador, el 12 al encendido y apagado de los leds, y los 4 últimos (13 al 16) realizan distintas lecturas de los sensores infrarrojos CNY70.

A continuación se detallan las funciones del código.

Funciones básicas Arduino

Inicialización

La inicialización del código se realiza en tres apartados. La definición de constantes se realiza en el archivo Types.h. La declaración de variables globales se situa al comienzo del archivo principal Arduino.ino. Por último, la inicialización se realiza en la función void setup().

Types.h

En este fichero se declaran las constantes empleadas en el código fuente.

Se dividen en las siguientes categorías

Constantes generales
- KMAXSPEED 400: Velocidad máxima a la que se pueden establecer los motores.
- KSTRAIGHTSPEED 300: Velocidad máxima para el modo de movimiento de velocidad-balance.
- KTURNSPEED 200: Velocidad de giro máxima para el modo de movimiento de velocidad-balance.
- MAX_ANALOG_RESOLUTION 1023: Resolución de lectura analógica.
- FRONTAL_TIMEOUT 2000: Tiempo máximo de lectura de los infrarrojos analógicos.
- CNY70DIVIDER 30: Valor a partir del cual un sensor infrarrojo de lectura analógica se considera negro.
Entradas
- NUMINPUTS 22: Número total de elementos de entrada.
- I_BUTTON 13: Pin del botón. No se utiliza.
- Matrices
  - O_IRON_AN 29: Pin de la matriz de sensores frontales. Para activar o desactivar todos los sensores frontales. Esto reduce el consumo eléctrico del robot.
  - O_IRON_DG 27: Pin de la matriz de sensores centrales.
- Sensores frontales
  - NUMFRONTS 12: Número de sensores frontales.
  - I_IR10 53: Pin del sensor frontal 1 (a la izquierda).
  - I_IR11 51: Pin del sensor frontal 2.
  - I_IR12 49: Pin del sensor frontal 3.
  - I_IR13 47: Pin del sensor frontal 4.
  - I_IR14 45: Pin del sensor frontal 5.
  - I_IR15 43: Pin del sensor frontal 6.
  - I_IR16 41: Pin del sensor frontal 7.
  - I_IR17 39: Pin del sensor frontal 8.
  - I_IR18 37: Pin del sensor frontal 9.
  - I_IR19 35: Pin del sensor frontal 10.
  - I_IR20 33: Pin del sensor frontal 11.
  - I_IR21 31: Pin del sensor frontal 12 (a la derecha).
- Sensores centrales
  - NUMMIDS 9: Número de sensores centrales.
  - I_IR1 4: Pin del sensor central 1 (a la izquierda).
  - I_IR2 5: Pin del sensor central 2.
  - I_IR3 A0: Pin del sensor central 3.
  - I_IR4 A1: Pin del sensor central 4.
  - I_IR5 6: Pin del sensor central 5.
  - I_IR6 A2: Pin del sensor central 6.
  - I_IR7 A3: Pin del sensor central 7.
  - I_IR8 11: Pin del sensor central 8.
  - I_IR9 12: Pin del sensor central 9 (a la derecha).
Salidas
- NUMOUTPUTS 21: Número total de elementos de salida.
- O_BUZZER 23: Pin del zumbador.
- LEDs
  - O_LED4 52: Pin del LED 1 (a la izquierda).
  - O_LED5 50: Pin del LED 2.
  - O_LED6 48: Pin del LED 3.
  - O_LED7 46: Pin del LED 4.
  - O_LED8 44: Pin del LED 5.
  - O_LED9 42: Pin del LED 6.
  - O_LED10 36: Pin del LED 7.
  - O_LED11 34: Pin del LED 8.
  - O_LED12 32: Pin del LED 9.
  - O_LED13 30: Pin del LED 10.
  - O_LED14 28: Pin del LED 11.
  - O_LED15 26: Pin del LED 12 (a la derecha).
  - O_LED16 24: Pin del LED central izquierdo.
  - O_LED17 22: Pin del LED central derecho.
- Motores
  - O_Ain1 9: Pin de la entrada 1 del motor derecho.
  - O_Ain2 7: Pin de la entrada 2 del motor derecho.
  - O_Bin1 10: Pin de la entrada 1 del motor izquierdo.
  - O_Bin2 8: Pin de la entrada 2 del motor izquierdo.
Listas
- const byte LEDS[NUMLEDS]: Vector que contiene las definiciones de pines de los LEDs.
- const byte MIDDLESENSORS[NUMMIDS]: Vector que contiene los sensores centrales.
- const byte FRONTSENSORS[NUMFRONTS]: Vector que contiene los sensores frontales.
- const byte INPUTS [NUMINPUTS]}: Vector que contiene todos los elementos de entrada.
- const byte OUTPUTS [NUMOUTPUTS]: Vector que contiene todos los elementos de salida.

Código fuente:

#ifndef _GR_TYPES
#define _GR_TYPES
#include "Arduino.h"

/**********************************************/
//
//            SYSTEM CONSTANTS
//
/**********************************************/

#define KMAXSPEED       400
#define KSTRAIGHTSPEED  300
#define KTURNSPEED      200


#define MAX_ANALOG_RESOLUTION 1023

#define FRONTAL_TIMEOUT 2000
#define CNY70DIVIDER 30

//-------------------------
//        INPUTS
//-------------------------

#define NUMINPUTS 22

//Push button (Pull-up)
#define  I_BUTTON	13


//On/off infrared sensors

#define  O_IRON_AN	29   // Analogical infrared (Pull-Up)
#define  O_IRON_DG	27   // Digital infrared (Pull-Down)

//Analog infrared sensors

#define NUMFRONTS  12

#define I_IR10	53
#define I_IR11	51
#define I_IR12	49
#define I_IR13	47
#define I_IR14	45
#define I_IR15	43
#define I_IR16	41
#define I_IR17	39
#define I_IR18	37
#define I_IR19	35
#define I_IR20	33
#define I_IR21	31

//Digital infrared sensors

#define NUMMIDS  9

#define I_IR1	4
#define I_IR2	5
#define I_IR3	A0
#define I_IR4	A1
#define I_IR5	6
#define I_IR6	A2
#define I_IR7	A3
#define I_IR8	11
#define I_IR9	12

//-------------------------
//        OUTPUTS
//-------------------------

#define NUMOUTPUTS 21

//Buzzer (Pull-Down)
#define  O_BUZZER	23


//LEDs

#define  NUMLEDS        14

#define  O_LED4		52
#define  O_LED5		50
#define  O_LED6		48
#define  O_LED7		46
#define  O_LED8		44
#define  O_LED9		42
#define  O_LED10	36
#define  O_LED11	34
#define  O_LED12	32
#define  O_LED13	30
#define  O_LED14	28
#define  O_LED15	26
#define  O_LED16	24
#define  O_LED17	22

//------------------------
//          Motor
//------------------------

//A channel
#define  O_Ain1	9
#define  O_Ain2	7

//B channel
#define  O_Bin1	10
#define  O_Bin2	 8

//------------------------
//          Lists
//------------------------

const byte LEDS[NUMLEDS] = { O_LED4, O_LED5,O_LED6,O_LED7,O_LED9,O_LED10,O_LED11,O_LED12,O_LED14,O_LED15,O_LED16,O_LED17 ,O_LED8, O_LED13 };

const byte MIDDLESENSORS[NUMMIDS] = {  I_IR1, I_IR2, I_IR3, I_IR4, I_IR5, I_IR6, I_IR7, I_IR8, I_IR9};
const byte FRONTSENSORS[NUMFRONTS] = { I_IR10, I_IR11, I_IR12, I_IR13, I_IR14, I_IR15, I_IR16, I_IR17, I_IR18, I_IR19, I_IR20, I_IR21    };

const byte INPUTS [NUMINPUTS]= { I_BUTTON, I_IR1, I_IR2, I_IR3, I_IR4, I_IR5, I_IR6, I_IR7, I_IR8, I_IR9, I_IR10, I_IR11, I_IR12, I_IR13, I_IR14, I_IR15, I_IR16, I_IR17, I_IR18, I_IR19, I_IR20, I_IR21  };
const byte OUTPUTS [NUMOUTPUTS] = { O_IRON_AN, O_IRON_DG , O_BUZZER,  O_LED4, O_LED5,O_LED6,O_LED7,O_LED8,O_LED9,O_LED10,O_LED11,O_LED12,O_LED13,O_LED14,O_LED15,O_LED16,O_LED17,O_Ain1,O_Ain2,O_Bin1,O_Bin2  };

#endif

Variables globales

Para la lectura de sonares se emplean variables globales. Contretamente, se definen las siguientes variables:

bool middleSensorValue [NUMMIDS]: Vector de 9 booleanos que contiene los últimos valores leídos de los sensores infrarrojos situados en la posición central. true indica negro y false blanco.
unsigned int frontSensorValue [NUMFRONTS]: Vector de 12 enteros sin signo que contiene los últimos valores leídos de los sensores infrarrojos situados en la posición frontal. El rango de valores es de [0,2000], donde 0 indica blanco absoluto y 2000 negro absoluto.
bool frontSensorBool [NUMFRONTS]: Vector de 12 booleanos que contiene los últimos valores leídos de los sensores infrarrojos situados en la posición frontal. true indica negro y false blanco.
bool isSensorRead [NUMFRONTS]: Vector auxiliar de 12 enteros sin signo empleado para la lectura de los sensores frontales. El uso de esta variable se explica en la función void read_front().

void setup()

Función obligatoria de inicialización del framework Arduino. Debe estar presente en el código, aunque no es necesario que realice operaciones. En caso de no definirse esta función el compilador devolverá un error de compilación.

No recibe parámetros.

Descripción de la función:

Inicializa el código.
Abre la comunicación serie a 9600 baudios para poder realizar la comunicación por USB con la Raspberry Pi, y establece los modos de los pines de entrada y salida.
También establece la resolución de la escritura analógica a 10 bytes (esto significa que los valores que se pueden escribir con la función analogWrite(pin,value) van desde 0 hasta 1023). Por defecto, Arduino Due tiene una resolución de 12 bytes, aunque para mantener la compatibilidad con Arduino Mega, la placa GOShieldGR tiene una resolución de 10 bytes. La escritura analógica se emplea en el movimiento de los motores.

Código fuente:

void setup()
{
	//Disables interrupts for the initialization
	noInterrupts();

	//Enables USB port for communication with Raspberry
	Serial.begin(9600);

	//Resolution of analogical port: 10 = 1024 (can be configured up to 12 = 4095)
	analogWriteResolution(10);
	
	//Configuration of input pins
	for (int i=0;i< NUMINPUTS  ;i++) 
	{
		pinMode(INPUTS[i],INPUT);
		digitalWrite(INPUTS[i], LOW);
	}
	
	//Configuration of output pins
	for (int i=0;i< NUMOUTPUTS ;i++)
	{
		pinMode(OUTPUTS[i],OUTPUT);
		digitalWrite(OUTPUTS[i], LOW);
	}
	
	//Activates interrupts again
	interrupts();
}

void loop()

Función obligatoria del framework Arduino. Debe estar presente en el código, aunque no es necesario que realice operaciones. En caso de no definirse esta función el compilador devolverá un error de compilación.

No recibe parámetros.

Descripción de la función:

Es el bucle principal del código. Una vez inicializado, se ejecuta eternamente.
Esta función espera a recibir un comando y mediante un switch llama a la función correspondiente.
Si hay 3 bytes disponibles en el buffer de la comunicación serie, lee el mensaje y mediante un switch invoca a la función que implementa el comando a ejecutar.

Los comandos disponibles son los siguientes:

stopMotors(): Detiene el movimiento de los motores
moveBalanced(speed,balance): Mueve los motores hacia adelante. El primer parámetro que recibe indica la velocidad, y el segundo el balance (0 se corresponde con un giro brusco a la izquierda, 123 avanza hazia adelante y 255 gira bruscamente a la derecha)
setLeftSpeed(speed): Establece la velocidad del motor izquierdo.
setRightSpeed(speed): Establece la velocidad del motor derecho.
moveForward(speed): Establece la velocidad de ambos motores.
turnLeft(speed): Establece la velocidad del motor izquierdo y detiene el derecho.
turnRight(speed): Establece la velocidad del motor derecho y detiene el izquierdo.
moveBackBalanced(speed,balance): Mueve los motores hacia atrás con velocidad y balance.
moveBackBoth(speed): Establece la velocidad de movimiento hacia atrás de ambos motores.
moveBackLeft(speed): Establece la velocidad de movimiento hacia atrás del motor izquierdo.
moveBackRight(speed): Establece la velocidad de movimiento hacia atrás del motor derecho.
beep(state): Establece el estado (encendido = 1, apagado = 0) del zumbador.
led(numLed, state): Enciende (_state_ = 1) o apaga (_state_ = 0) el led _numLed_ (entre 0 y 13).
sendFrontAndMiddle(): Lee todos los sensores infrarrojos y los envía los valores por USB.
sendFront(): Lee los sensores frontales en binario (negro = 1, blanco = 0) y envía los valores por USB.
sendMiddle(): Lee los sensores centrales en binario (negro = 1, blanco = 0) y envía los valores por USB.
sendAnalogFront(): Lee los sensores frontales en analógico y envía los valores por USB.

Código fuente:

void loop()
{
	//Receive a message (3 bytes)
	if (Serial.available() >= 3)
	{
		byte cmd = Serial.read();  //Command
		byte p1  = Serial.read();  //First parameter
		byte p2  = Serial.read();  //Second parameter
		
		switch (cmd)
		{
			//Command 0 -> Stop
			case 0:
			stopMotors();
			break;
			
			//Command 1 -> Move forwards with speed and balance
			case 1:
			moveBalanced(p1,p2);
			break;
			
			//Set left motor to <SPEED>
			case 2:
			setLeftSpeed(p1);
			break;
			
			//Set right motor to <SPEED>
			case 3:
			setRightSpeed(p1);
			break;
			
			//Move forward to <SPEED>
			case 4:
			moveForwards(p1);
			break;
			
			//Set left motor to <SPEED> and right motor to 0
			case 5:
			turnLeft(p1);
			break;
			
			//Set right motor to <SPEED> and left motor to 0
			case 6:
			turnRight(p1);
			break;
			
			//Move backwards with speed and balance
			case 7:
			moveBackBalanced(p1,p2);
			break;
			
			//Set both motors to back speed
			case 8:
			moveBackBoth(p1);
			break;
			
			//Set left motor to back speed
			case 9:
			moveBackLeft(p1);
			break;
			
			//Set right motor to back speed
			case 10:
			moveBackRight(p1);
			break;
			
			//Beep
			case 11:
			beep(p1);
			break;
			
			//LED <0..13> <ON|OFF>
			case 12:
			led(p1,p2);
			break;
			
			//Send all CNY70 values. First front and then middle
			case 13:
			sendFrontAndMiddle();
			break;
			
			//Send front sensor values
			case 14:
			sendFront();
			break;
			
			//Send middle sensor values
			case 15:
			sendMiddle();
			break;
			
			//Send analog values of front sensor
			case 16:
			sendAnalogFront();
		}
	}
}

Funciones de motores

A continuación se explican las funciones asociadas al movimiento de los motores. Cada motor tiene asociadas 2 señales para controlar su movimiento.

La explicación detallada del funcionamiento de los motores está disponible <<<en esta página>>>.

Movimiente hacia adelante

void stopMotors()

Esta función implementa el comando 0.

Puede ser invocada desde Raspberry Pi mediante el mensaje: [0,0,0] (bytes).

No recibe parámetros.

Realiza lo siguiente:

Realiza un frenado por bloqueo estableciendo las 4 señales de los motores al valor máximo.

Este freno es el más rápido, aunque también el más agresivo. Para realizar un frenado gradual (también llamado frenado por descarga o frenado al aire) se puede emplear la función moveForward(0), que se corresponde con la señal [4,0,0].

El código es el siguiente:

void stopMotors()
{
	analogWrite(O_Bin1,MAX_ANALOG_RESOLUTION);
	digitalWrite(O_Bin2,HIGH);
	analogWrite(O_Ain1,MAX_ANALOG_RESOLUTION);
	digitalWrite(O_Ain2,HIGH);
}

El código es el siguiente:

void setForwardSpeedRight(int speed)

Función interna, es invocada desde otras funciones, nunca directamente desde la Raspberry ya que primero el valor debe ser escalado desde [0,255] a [0,KMAXSPEED]

Recibe un valor entre 0 y KMAXSPEED. Esta constante es la velocidad máxima de los motores, que por defecto es 400, y como máximo puede ser 1023, que es la resolución de la escritura analógica. Poner los motores a máxima velocidad no es recomendable ya se pueden dañar. La velocidad máxima recomendada es de 750, aunque esto hace la conducción del robot complicada.

Establece la primera señal del motor derecho a la velocidad indicada, y la segunda a nivel bajo. Si la velocidad está fuera del rango permitido, establece la misma al valor máximo o mínimo según corresponda.

void setForwardSpeedRight(int speed)
{
	//Check if numbers are out of range
	if      (speed < 0)         speed = 0;
	else if (speed > KMAXSPEED) speed = KMAXSPEED;

	//Set motor speed
	analogWrite(O_Ain1,speed);
	digitalWrite(O_Ain2,LOW);
}

void setForwardSpeedLeft(int speed)

Función interna, es invocada desde otras funciones, nunca directamente desde la Raspberry ya que primero el valor debe ser escalado desde [0,255] a [0,KMAXSPEED]

Recibe un valor entre 0 y KMAXSPEED. Esta constante es la velocidad máxima de los motores, que por defecto es 400, y como máximo puede ser 1023, que es la resolución de la escritura analógica. Poner los motores a máxima velocidad no es recomendable ya se pueden dañar. La velocidad máxima recomendada es de 750, aunque esto hace la conducción del robot complicada.

Establece la primera señal del motor izquierdo a la velocidad indicada, y la segunda a nivel bajo. Si la velocidad está fuera del rango permitido, establece la misma al valor máximo o mínimo según corresponda.

void setForwardSpeedLeft(int speed)
{
	//Check if numbers are out of range
	if      (speed < 0)         speed = 0;
	else if (speed > KMAXSPEED) speed = KMAXSPEED;

	//Set motor speed
	analogWrite(O_Bin1,speed);
	digitalWrite(O_Bin2,LOW);
}

setMotors(int left, int right)

Función interna, es invocada desde otras funciones, nunca directamente desde la Raspberry ya que primero el valor debe ser escalado desde [0,255] a [0,KMAXSPEED]

Recibe los parámetros:

int left Velocidad del motor izquierdo entre [0,KMAXSPEED]
int right Velocidad del motor dercho entre [0,KMAXSPEED]

Establece la velocidad de los motores haciendo uso de las funciones auxiliares setForwardSpeedRight(left) y setForwardSpeedLeft(right)

void setMotors(int left, int right)
{
	setForwardSpeedRight(left);
	setForwardSpeedLeft(right);
}

void turnLeft(byte speed)

Esta función implementa el comando 5.

Puede ser invocada desde Raspberry Pi mediante el comando: [5,<speed>,0] (bytes)

Recibe el parámetro:

byte speed: Velocidad en el rango [0,255] a la que se establece el motor izquierdo.

Descripción de la función:

Escala el valor recibido en el parámetro speed de [0,255] a [0,KMAXSPEED] y establece la velocidad del motor izquierdo. Además, establece a 0 la velocidad del motor derecho, esto garantiza que (en caso de proporcionar una velocidad de giro suficiente) se realice el giro.

Código fuente:

void turnLeft(byte speed)
{
	int speedMapped = map(speed,0,255,0,KMAXSPEED);
	setForwardSpeedRight(0);
	setForwardSpeedLeft(speedMapped);
}

void turnRight(byte speed)

Esta función implementa el comando 6.

Puede ser invocada desde Raspberry Pi mediante el comando: [6,<speed>,0] (bytes)

Recibe el parámetro:

byte speed: Velocidad en el rango [0,255] a la que se establece el motor derecho.

Descripción de la función:

Escala el valor recibido en el parámetro speed de [0,255] a [0,KMAXSPEED] y establece la velocidad del motor derecho. Además, establece a 0 la velocidad del motor izquierdo, esto garantiza que (en caso de proporcionar una velocidad de giro suficiente) se realice el giro.

Código fuente:

void turnRight(byte speed)
{
	int speedMapped = map(speed,0,255,0,KMAXSPEED);
	setForwardSpeedRight(speedMapped);
	setForwardSpeedLeft(0);
}

void setLeftSpeed(byte speed)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void setLeftSpeed(byte speed)
{
	int speedMapped = map(speed,0,255,0,KMAXSPEED);
	setForwardSpeedLeft(speedMapped);
}

void setRightSpeed(byte speed)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void setRightSpeed(byte speed)
{
	int speedMapped = map(speed,0,255,0,KMAXSPEED);
	setForwardSpeedRight(speedMapped);
}

void moveBalanced(byte speed, byte balance)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void moveBalanced(byte speed, byte balance)
{
	//Sets speed between 0 and KMAXSPEED
	int speedMapped = map(speed,0,255,0,KSTRAIGHTSPEED);

	//Sets balance between -KTURNSPEED and KTURNSPEED
	int balanceMapped = map(balance,0,255,-KTURNSPEED,KTURNSPEED);

	//Sets speed of left and right motors
	int left = speedMapped - balanceMapped;
	int right = speedMapped + balanceMapped;

	setMotors(left,right);
}

void moveForwards(byte speed)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void moveForwards(byte speed)
{
	//Sets speed between 0 and KMAXSPEED
	int speedMapped = map(speed,0,255,0,KMAXSPEED);

	setMotors(speedMapped,speedMapped);
}

Movimiento hacia atrás

void setBackSpeedLeft(int speed)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void setBacSpeedLeft(int speed)
{
	//Check if numbers are out of range
	if      (speed < 0)         speed = 0;
	else if (speed > KMAXSPEED) speed = KMAXSPEED;

	//Set motor speed
	analogWrite(O_Bin1,MAX_ANALOG_RESOLUTION-speed);
	digitalWrite(O_Bin2,HIGH);
}

void setBackSpeedRight(int speed)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void setBackSpeedRight(int speed)
{
	//Check if numbers are out of range
	if      (speed < 0)         speed = 0;
	else if (speed > KMAXSPEED) speed = KMAXSPEED;

	//Set motor speed
	analogWrite(O_Ain1,MAX_ANALOG_RESOLUTION-speed);
	digitalWrite(O_Ain2,HIGH);
}

void moveBackBalanced(byte speed, byte balance)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void moveBackBalanced(byte speed, byte balance)
{
	//Sets speed between 0 and KMAXSPEED
	int speedMapped = map(speed,0,255,0,KSTRAIGHTSPEED);

	//Sets balance between -KTURNSPEED and KTURNSPEED
	int balanceMapped = map(balance,0,255,-KTURNSPEED,KTURNSPEED);

	//Sets speed of left and right motors
	int left = speedMapped - balanceMapped;
	int right = speedMapped + balanceMapped;

	setBackwardSpeedLeft(left);
	setBackwardSpeedRight(right);
}

void moveBackBoth(byte speed)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void moveBackBoth(byte speed)
{
	//Sets speed between 0 and KMAXSPEED
	int kspeed = map(speed,0,255,0,KMAXSPEED);
	setBackwardSpeedLeft(kspeed);
	setBackwardSpeedRight(kspeed);
}

void moveBackLeft(byte speed)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void moveBackLeft(byte speed)
{
	//Sets speed between 0 and KMAXSPEED
	setBackwardSpeedLeft(map(speed,0,255,0,KMAXSPEED));
}

void moveBackRight(byte speed)

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void moveBackRight(byte speed)
{
	//Sets speed between 0 and KMAXSPEED
	setBackwardSpeedRight(map(speed,0,255,0,KMAXSPEED));
}

Funciones de lectura infrarrojos

void sendFrontAndMiddle()

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void sendFrontAndMiddle()
{
	read_front();
	readMiddle();

	for(int i = 0; i < 12; i++)
	{
		Serial.print(frontSensorBool[i]);
	}
	
	for (int i = 0; i< 9; i++)
	{
		Serial.print(middleSensorValue[i]);
	}
	Serial.println();
}

void sendFront()

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void sendFront()
{	
	read_front();

	for(int i = 0; i < 12; i++)
	{
		Serial.print(frontSensorBool[i]);
	}
	Serial.println();
	
}

void sendMiddle()

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void sendMiddle()
{
	readMiddle();
	
	for (int i = 0; i< 9; i++)
	{
		Serial.print(middleSensorValue[i]);
	}
	Serial.println();
}

void sendAnalogFront()

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void sendAnalogFront()
{
	read_front();
	
	for(int i = 0; i < 11; i++)
	{
		Serial.print(frontSensorValue[i]);
		Serial.print(",");
	}
	Serial.println(frontSensorValue[11]);
}

void readMiddle()

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void readMiddle()
{
	digitalWrite(O_IRON_DG,HIGH);
	delay(10);	
	for ( int i = 0 ;  i < 9; i++)
	{
		middleSensorValue[i] = !digitalRead(MIDDLESENSORS[i]);
	}
	digitalWrite(O_IRON_DG,LOW);
}

void read_front()

Esta función implementa el comando ``.

Puede ser invocada desde Raspberry Pi mediante el comando: [,,] (bytes)

Recibe el parámetro:

``: .

Descripción de la función:

.

Código fuente:

void read_front()
{
	//Unload capacitors
	for (int i = 0; i < 12; i++)
	{
		pinMode(FRONTSENSORS[i], OUTPUT);
		digitalWrite(FRONTSENSORS[i],HIGH);
	}
	delayMicroseconds(15);
	
	//Load capacitors
	for (int i = 0; i < 12; i++)
	{
		pinMode(FRONTSENSORS[i], INPUT);
		digitalWrite(FRONTSENSORS[i],LOW);
	}
	
	//Switch on IR matrix
	digitalWrite(O_IRON_AN,HIGH);
	delayMicroseconds(5);
	
	//Read
	int cTiempo = 0;
	int cSensores = 0;
	while (cTiempo < FRONTAL_TIMEOUT && cSensores < 12)
	{
		for (int i = 0; i < 12; i++)
		{
			if (digitalRead(FRONTSENSORS[i]) == LOW && !isSensorRead[i])
			{
				frontSensorValue[i] = cTiempo;
				frontSensorBool[i] = cTiempo >= CNY70DIVIDER;
				
				isSensorRead[i] = true;
				cSensores++;
			}
		}
		cTiempo++;
		delayMicroseconds(1);
	}
	
	//Reset and set timeout values
	for (int i = 0; i < 12; i++)
	{
		if (isSensorRead[i])
		{
			isSensorRead[i] = false;
		}
		else
		{
			frontSensorValue[i] = 0;
			frontSensorBool[i] = 0;
		}
	}
	
	//Switch off IR matrix
	digitalWrite(O_IRON_AN,LOW);
}

Otros comandos

void led(byte num,bool state)

Esta función implementa el comando 12.

Puede ser invocada desde Raspberry Pi mediante el comando: [12,<numLed>,<state>] (bytes)

Recibe los parámetros:

byte num: .
bool state: .

Descripción de la función:

Controla el estado de los leds. Esta función puede ser invocada por comunicación USB con el comando 12, y recibe 2 parámetros. El primero, entre 0 y 13 se corresponde con el número de led. El segundo indica el estado (1 es encendido, y 0 apagado).
La placa GoShield-GR lleva incorporados 14 leds, 12 de ellos en las posiciones de los sensores frontales, y otros 2 en el centro. Por tanto, para establecer su estado (encendido o apagado), se envía como primer parámetro un valor numérico entre 0 y 13, donde 0 es el led situado más a la izquierda, 11 el que está más a la derecha, y 13 y 14 los dos leds adicionales situados en el centro.
Esta función comprueba el rango de los leds, entre o y 13. Si el valor es mayor, encenderá el led número 13, correspondiente al led secundario central situado ligeramente a la derecha.
Por otra parte, recibe como segundo parámetro un booleano que indica el estado del led. Si un valor es distinto de 0, se considera true y se encenderá el led. En caso de recibir un 0, el estado del led será apagado.

Código fuente:

void led(byte num,bool state)
{
	if		(num < 0)			num = 0;
	else if (num >= NUMLEDS)	num = NUMLEDS-1;
	
	digitalWrite(LEDS[num],state);
}

void beep(bool status)

Esta función implementa el comando 11.

Puede ser invocada desde Raspberry Pi mediante el comando: [11,<status>,0] (bytes)

Recibe el parámetro:

bool status: Estado del zumbador. 0 o false es apagado. true u otro valor es encendido.

Descripción de la función:

Establece el estado del zumbador, o claxon. 0 equivale a apagado, y cualquier otro valor (entre 1 y 255) establece el zumbador a activo.

Código fuente:

void beep(bool status)
{
	digitalWrite(O_BUZZER,status);
}

Introducción
Qué es Charlie
Objetivos
Alcance
Proyectos similares
Cómo controlar el robot
Aspectos generales
Modo de conducción libre
Modo de programación gráfica 1. Ejemplos 2. Referencia de instrucciones
Depuración
Instalación
Hardware
Software
Configuración de red
Funcionamiento
Comunicaciones
Blockly
Motores
Cámara
Comandos
Explicación del código fuente
Código de Arduino
Aplicación Android
Página web
Servidor de comandos
Script de arranque
Resultados
Evolución del proyecto
Trabajo descartado
Futuras ampliaciones
Resultado final
Agradecimientos
Referencias
Fuentes consultadas
Datasheets

Provide feedback

Saved searches

Use saved searches to filter your results more quickly

Código Arduino

Funciones básicas Arduino

Inicialización

Types.h

Variables globales

void setup()

void loop()

Funciones de motores

Movimiente hacia adelante

void stopMotors()

void setForwardSpeedRight(int speed)

void setForwardSpeedLeft(int speed)

setMotors(int left, int right)

void turnLeft(byte speed)

void turnRight(byte speed)

void setLeftSpeed(byte speed)

void setRightSpeed(byte speed)

void moveBalanced(byte speed, byte balance)

void moveForwards(byte speed)

Movimiento hacia atrás

void setBackSpeedLeft(int speed)

void setBackSpeedRight(int speed)

void moveBackBalanced(byte speed, byte balance)

void moveBackBoth(byte speed)

void moveBackLeft(byte speed)

void moveBackRight(byte speed)

Funciones de lectura infrarrojos

void sendFrontAndMiddle()

void sendFront()

void sendMiddle()

void sendAnalogFront()

void readMiddle()

void read_front()

Otros comandos

void led(byte num,bool state)

void beep(bool status)

Clone this wiki locally