-
Notifications
You must be signed in to change notification settings - Fork 0
/
Motores.asm
69 lines (55 loc) · 2.01 KB
/
Motores.asm
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
#ifndef MOTORES_ASM
#define MOTORES_ASM
#include "Motor.asm"
#define VEL_MOTOR_IZDO 255
#define VEL_MOTOR_DCHO 251
#define Motores(_vcc1, _gnd1, _enable1, _vcc2, _gnd2, _enable2) m_motores _vcc1, _gnd1, _enable1, _vcc2, _gnd2, _enable2
#define Motores_adelante() m_motores_adelante VEL_MOTOR_IZDO,VEL_MOTOR_DCHO
#define Motores_adelante_2(_vel1,_vel2) m_motores_adelante _vel1,_vel2
#define Motores_detener() m_motores_detener
#define Motores_retroceso() m_motores_retroceso
#define Motores_giroRapidoIzquierda() m_motores_giro_rapido_izquierda VEL_MOTOR_IZDO,VEL_MOTOR_DCHO
#define Motores_giroRapidoIzquierda_2(_vel1,_vel2) m_motores_giro_rapido_izquierda _vel1,_vel2
#define Motores_giroRapidoDerecha() m_motores_giro_rapido_derecha VEL_MOTOR_IZDO,VEL_MOTOR_DCHO
#define Motores_giroRapidoDerecha_2(_vel1,_vel2) m_motores_giro_rapido_derecha _vel1,_vel2
#define Motores_giroIzquierda() m_motores_giro_izquierda
#define Motores_giroDerecha() m_motores_giro_derecha
.MACRO m_motores
Motor(motorIzquierdo, @0, @1, @2)
Motor(motorDerecho, @3, @4, @5)
.ENDM
// params @0 Velocidad, motor izquierdo
// params @1 Velocidad, motor derecho
.MACRO m_motores_adelante
Motor_adelante_2(motorDerecho, @1)
Motor_adelante_2(motorIzquierdo, @0)
.ENDM
.MACRO m_motores_detener
Motor_detener(motorDerecho)
Motor_detener(motorIzquierdo)
.ENDM
.MACRO m_motores_retroceso
Motor_retroceso(motorDerecho)
Motor_retroceso(motorIzquierdo)
.ENDM
// params @0 Velocidad, motor izquierdo
// params @1 Velocidad, motor derecho
.MACRO m_motores_giro_rapido_derecha
Motor_adelante_2(motorIzquierdo, @0)
Motor_retroceso_2(motorDerecho, @1)
.ENDM
// params @0 Velocidad, motor izquierdo
// params @1 Velocidad, motor derecho
.MACRO m_motores_giro_rapido_izquierda
Motor_retroceso_2(motorIzquierdo, @0)
Motor_adelante_2(motorDerecho, @1)
.ENDM
.MACRO m_motores_giro_derecha
Motor_adelante(motorIzquierdo)
Motor_detener(motorDerecho)
.ENDM
.MACRO m_motores_giro_izquierda
Motor_detener(motorIzquierdo)
Motor_adelante(motorDerecho)
.ENDM
#endif // MOTORES_ASM