Onier / RC_Servo

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   SoftPWM

Fork of RC_Servo by FRC - Hackathon

Diff: RC_Servo.cpp

Revision:
0:b8dcca3dc509
Child:
1:8482eba4d652
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/RC_Servo.cpp	Mon May 21 15:55:54 2018 +0000
@@ -0,0 +1,27 @@
+#include "RC_Servo.h"
+
+RC_Servo::RC_Servo(PinName PWM, int _extended) : _pwm(PWM)
+{
+    _pwm.period(0.02);
+    if (_extended) {
+        _pMin = 400;
+        _pMax = 2400;
+    } else {
+        _pMin = 1000;
+        _pMax = 2000;
+    }
+}
+
+void RC_Servo::write (float position)
+{
+    if ((position >= 0) && (position <= 1))
+        _pwm.pulsewidth_us (_pMin + (int)(position * (_pMax - _pMin)));
+}
+
+/**
+ * A short hand for write
+ */
+RC_Servo& RC_Servo::operator= (float position)
+{
+    write (position);
+}