robot/mode_dirc.c


1
2
3
4
5
6
7
8
9
10
11
12
13

#include "mode_dirc.h"
#include "io.h"

#include "orangutan_shim.h"

int16_t g_w2_mode_dirc_motor_l = 0;
int16_t g_w2_mode_dirc_motor_r = 0;

void w2_mode_dirc() {
	set_motors(g_w2_mode_dirc_motor_l, g_w2_mode_dirc_motor_r);
	g_w2_io.motor_left.speed  = g_w2_mode_dirc_motor_l;
	g_w2_io.motor_right.speed = g_w2_mode_dirc_motor_r;
}