23 lines
337 B
C++
23 lines
337 B
C++
|
/*
|
||
|
|
* 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_ */
|