#if !defined(__SERVO_H__)
#define __SERVO_H__

/* 設定SW: サーボモータ可動範囲 */
enum e_degree_range {
  DEGREE_RANGE_90 = 0,
  DEGREE_RANGE_180
};

/* 設定SW: サーボモータ動作速度 */
enum e_move_speed {
  MOVE_SPEED_NORMAL = 0,
  MOVE_SPEED_SLOW
};

/* サーボモータのパルス周期 20000 [uSec] = 20 [mSec] */
#define PULSE_CYCLE         20000  

/* サーボモータのパルス幅: 中点*/
#define PULSE_WIDTH_NEUTRAL  1500 /* [uSec] */

/* サーボモータのパルス幅　最小/最大 */
#define PULSE_WIDTH_90_MIN  (PULSE_WIDTH_NEUTRAL-500)
#define PULSE_WIDTH_90_MAX  (PULSE_WIDTH_NEUTRAL+500)
#define PULSE_WIDTH_180_MIN (PULSE_WIDTH_NEUTRAL-1000)
#define PULSE_WIDTH_180_MAX (PULSE_WIDTH_NEUTRAL+1000)

/* 出力パルス幅を計算 (0 <= p <= 1023) [uSec]
 *   範囲 90度: p + 1000  (= 1000 ... 2023 [uSec]) 
 *   範囲180度: 2*p + 500 (= 500 ... 2546 [uSec]) */
#define PULSE_WIDTH_90(p)  ((p)        + PULSE_WIDTH_90_MIN)
#define PULSE_WIDTH_180(p) (((p) << 1) + PULSE_WIDTH_180_MIN)

extern enum e_degree_range sw_degree_range;
extern enum e_move_speed sw_move_speed;
extern void servo_pulse(uint16_t pos);

#endif /*__SERVO_H__*/
