SimpleRSLK.h

Go to the documentation of this file.

 
#include "RSLK_Pins.h"
#include "QTRSensors.h"
#include "GP2Y0A21_Sensor.h"
#include "Encoder.h"
#include "Romi_Motor_Power.h"
#include "Bump_Switch.h"
 
#ifndef SimpleRSLK_h
#define SimpleRSLK_h
 
 
#define LS_NUM_SENSORS   8     // number of sensors used
 
/*
 * @brief   Total number of bump switches.
 */
#define TOTAL_BP_SW 6
 
#define LEFT_MOTOR 0
 
#define RIGHT_MOTOR 1
 
#define BOTH_MOTORS 2
 
#define MOTOR_DIR_FORWARD 0
 
#define MOTOR_DIR_BACKWARD 1
 
#define DARK_LINE 0
 
#define LIGHT_LINE 1
 
void setupRSLK();
 
uint16_t readSharpDist(uint8_t num);
 
bool isBumpSwitchPressed(uint8_t num);
 
void enableMotor(uint8_t motorNum);
 
void disableMotor(uint8_t motorNum);
 
void pauseMotor(uint8_t motorNum);
 
void resumeMotor(uint8_t motorNum);
 
 
void setMotorDirection(uint8_t motorNum,uint8_t direction);
 
void setMotorSpeed(uint8_t motorNum, uint8_t speed);
 
void readLineSensor(uint16_t *sensor);
 
void setupWaitBtn(uint8_t btn);
 
void waitBtnPressed(uint8_t btn);
 
void clearMinMax(uint16_t *sensorMin,uint16_t *sensorMax);
 
void setSensorMinMax(uint16_t *sensor,uint16_t *sensorMin,uint16_t *sensorMax);
 
 
void readCalLineSensor(uint16_t* sensor,
                       uint16_t* calVal,
                       uint16_t *sensorMin,
                       uint16_t *sensorMax,
                       uint8_t mode);
 
uint32_t getLinePosition(uint16_t* calVal, uint8_t mode);
 
#endif