Manual

www.nexusrobot.com Robot Kits manual
93
¾ Omni3WD platform with 6 SONARS
Look the above figure of simple Wiring Diagram for Omni3WD_V3.3. Tis code is matched for it
Diagram_Omni3WD_V3.3 code
/********************************************************************/
/*
Power Switch
Sonar0x11
-----------------------
/ \
/ \
Sonar0x16 / \ Sonar0x12
M3,IR03 / \ M2,IR02
/ \
/ \
/ \
/ \
\ /
\ /
\ /
\ /
Sonar0x15 \ / Sonar0x13
\ /
\ /
------------------------
Sonar0x14
M1,IR01
*/
#include <fuzzy_table.h>
#include <PID_Beta6.h>
#include <PinChangeInt.h>
#include <PinChangeIntConfig.h>
#include <MotorWheel.h>
#include <Omni3WD.h>
#include <SONAR.h> // Include the header files
/******************************************/
// SONAR