Scott Lahteine
7 years ago
committed by
GitHub
GitHub
35 changed files with 354 additions and 283 deletions
@ -0,0 +1,54 @@ |
|||
/**
|
|||
* Marlin 3D Printer Firmware |
|||
* Copyright (C) 2016 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
|||
* |
|||
* Based on Sprinter and grbl. |
|||
* Copyright (C) 2011 Camiel Gubbels / Erik van der Zalm |
|||
* |
|||
* This program is free software: you can redistribute it and/or modify |
|||
* it under the terms of the GNU General Public License as published by |
|||
* the Free Software Foundation, either version 3 of the License, or |
|||
* (at your option) any later version. |
|||
* |
|||
* This program is distributed in the hope that it will be useful, |
|||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|||
* GNU General Public License for more details. |
|||
* |
|||
* You should have received a copy of the GNU General Public License |
|||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|||
* |
|||
*/ |
|||
|
|||
/**
|
|||
* module/servo.cpp |
|||
*/ |
|||
|
|||
#include "../inc/MarlinConfig.h" |
|||
|
|||
#if HAS_SERVOS |
|||
|
|||
#include "servo.h" |
|||
|
|||
HAL_SERVO_LIB servo[NUM_SERVOS]; |
|||
|
|||
void servo_init() { |
|||
#if NUM_SERVOS >= 1 && HAS_SERVO_0 |
|||
servo[0].attach(SERVO0_PIN); |
|||
servo[0].detach(); // Just set up the pin. We don't have a position yet. Don't move to a random position.
|
|||
#endif |
|||
#if NUM_SERVOS >= 2 && HAS_SERVO_1 |
|||
servo[1].attach(SERVO1_PIN); |
|||
servo[1].detach(); |
|||
#endif |
|||
#if NUM_SERVOS >= 3 && HAS_SERVO_2 |
|||
servo[2].attach(SERVO2_PIN); |
|||
servo[2].detach(); |
|||
#endif |
|||
#if NUM_SERVOS >= 4 && HAS_SERVO_3 |
|||
servo[3].attach(SERVO3_PIN); |
|||
servo[3].detach(); |
|||
#endif |
|||
} |
|||
|
|||
#endif // HAS_SERVOS
|
|||
@ -0,0 +1,44 @@ |
|||
/**
|
|||
* Marlin 3D Printer Firmware |
|||
* Copyright (C) 2016 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
|||
* |
|||
* Based on Sprinter and grbl. |
|||
* Copyright (C) 2011 Camiel Gubbels / Erik van der Zalm |
|||
* |
|||
* This program is free software: you can redistribute it and/or modify |
|||
* it under the terms of the GNU General Public License as published by |
|||
* the Free Software Foundation, either version 3 of the License, or |
|||
* (at your option) any later version. |
|||
* |
|||
* This program is distributed in the hope that it will be useful, |
|||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|||
* GNU General Public License for more details. |
|||
* |
|||
* You should have received a copy of the GNU General Public License |
|||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|||
* |
|||
*/ |
|||
|
|||
/**
|
|||
* module/servo.h |
|||
*/ |
|||
|
|||
#ifndef _SERVO_H_ |
|||
#define _SERVO_H_ |
|||
|
|||
#include "../HAL/servo.h" |
|||
|
|||
extern HAL_SERVO_LIB servo[NUM_SERVOS]; |
|||
extern void servo_init(); |
|||
|
|||
#define MOVE_SERVO(I, P) servo[I].move(P) |
|||
|
|||
#include "../inc/MarlinConfig.h" |
|||
|
|||
#if HAS_Z_SERVO_ENDSTOP |
|||
#define DEPLOY_Z_SERVO() MOVE_SERVO(Z_ENDSTOP_SERVO_NR, z_servo_angle[0]) |
|||
#define STOW_Z_SERVO() MOVE_SERVO(Z_ENDSTOP_SERVO_NR, z_servo_angle[1]) |
|||
#endif |
|||
|
|||
#endif // _SERVO_H_
|
|||
Loading…
Reference in new issue