pinmap_smallkat.h

/*
 * pinmap_smallkat.h
 *
 *  Created on: Dec 15, 2020
 *      Author: hephaestus
 */

#ifndef SRC_PINMAP_SMALLKAT_H_
#define SRC_PINMAP_SMALLKAT_H_

// https://github.com/WPIRoboticsEngineering/RobotInterfaceBoard/blob/master/docs/board.png

#define FRONT_RIGHT_NECK 23 //0
#define FRONT_LEFT_NECK 32 //1
#define REAR_RIGHT_TAIL 15 //2
#define REAR_LEFT_TAIL 13 //3

#define FRONT_RIGHT_SHOULDER_TILT 19 //4
#define FRONT_RIGHT_SHOULDER_FORWARD_BACKWARD 18 //5
#define FRONT_RIGHT_ELBOW 5 //6

#define FRONT_LEFT_SHOULDER_TILT 33 //7
#define FRONT_LEFT_SHOULDER_FORWARD_BACKWARD 25 //8
#define FRONT_LEFT_ELBOW 26 //9

#define REAR_RIGHT_SHOULDER_TILT 2 //10
#define REAR_RIGHT_SHOULDER_FORWARD_BACKWARD 4 //11
#define REAR_RIGHT_ELBOW 16 //12

#define REAR_LEFT_SHOULDER_TILT 12 //13
#define REAR_LEFT_SHOULDER_FORWARD_BACKWARD 14 //14
#define REAR_LEFT_ELBOW 27 //15

#define PAN_NECK -1 //16
#define TILT_NECK -1 //17
#define PAN_TAIL -1 //18
#define TILT_TAIL-1 //19

#endif /* SRC_PINMAP_SMALLKAT_H_ */