Manual

www.nexusrobot.com Robot Kits manual
89
¾ Omni3WD platform with 3 SONARS
Look the above figure of simple Wiring Diagram for Omni3WD_V1.0. Tis code is matched for it
Diagram_Omni3WD_V1.0 code
/********************************************************************/
/*
Power Switch
Sonar0x11
-------------------------
/ \
/ \
/ \
M3 / \ M2
INT0 / \INT1
/ \
/ \
/ \
\ /
\ /
\ /
\ /
Sonar0x12 \ / Sonar0x13
\ /
\ /
--------------------------
M1
*/
#include <fuzzy_table.h>
#include <PID_Beta6.h>
#include <PinChangeIntConfig.h>
#include <MotorWheel.h>
#include <Omni3WD.h>
#include <SONAR.h> // Include the header files
/******************************************/
// SONAR