/*
 * movement.hpp
 *
 *  Created on: 17.01.2021
 *      Author: frank
 */

#ifndef MOVEMENT_HPP_
#define MOVEMENT_HPP_

#include "ax12.h"
#include "servo-control.hpp"

#define AMPLITUDE 35
#define WAVE_LENGTH 3
#define PHASE_SHIFT M_PI / SERVO_COUNT
#define INTER_SERVO_MOVEMENT_DELAY_MS 4

void slither();


#endif /* MOVEMENT_HPP_ */