Add PWM

Author: Joe7M

src/platform/teensy/samples/pwm_led.bas

@@ -0,0 +1,13 @@
+' 8 bit PWM with built-in LED
+
+import teensy
+
+const BuiltInLED = teensy.openAnalogOutput(13)
+
+while(1)
+  brightness++
+  if(brightness > 255) then brightness = 0
+  print brightness
+  BuiltInLED.write(brightness)
+  delay(10)
+wend

src/platform/teensy/samples/pwm_led_2.bas

@@ -0,0 +1,17 @@
+' 12 bit PWM with built-in LED
+' For frequency settings see https://www.pjrc.com/teensy/td_pulse.html
+
+import teensy
+
+const BuiltInLED = teensy.openAnalogOutput(13)
+
+BuiltInLED.Frequency(36621.09)
+BuiltInLED.Resolution(12)
+
+while(1)
+  brightness++
+  if(brightness > 4095) then brightness = 0
+  print brightness
+  BuiltInLED.write(brightness)
+  delay(1)
+wend

src/platform/teensy/samples/serialprint.bas

@@ -0,0 +1,7 @@
+import teensy
+
+while(1)
+  ii++
+  print ii
+  delay(500)
+wend

src/platform/teensy/src/main.cpp

@@ -96,13 +96,6 @@ void setup() {
 void serial_read() {
   bool eof = false;
   int lastRead = -1;
-
-  while(!Serial){
-    delay(10);
-  }
-
-  dev_print("Waiting for data... ");
-
   buffer.clear();
 
   while (!eof) {
@@ -116,6 +109,7 @@ void serial_read() {
       eof = true;
     } else {
       delay(250);
+      dev_print("\rInteractive mode - waiting for data...");
     }
   }
   dev_printf("received %d bytes.\r\n", buffer.length());
@@ -186,7 +180,6 @@ extern "C" int main(void) {
   setup();
 
 #if INTERACTIVE
-  dev_print("Interactive mode enabled\r\n");
   interactive_main();
 #else
   if (!sbasic_main(MAIN_BAS)) {

src/platform/teensy/src/module.cpp

@@ -48,6 +48,26 @@ int get_param_int(int argc, slib_par_t *params, int n, int def) {
   return result;
 }
 
+double get_param_num(int argc, slib_par_t *params, int n, double def) {
+  double result;
+  if (n >= 0 && n < argc) {
+    switch (params[n].var_p->type) {
+    case V_INT:
+      result = params[n].var_p->v.i;
+      break;
+    case V_NUM:
+      result = params[n].var_p->v.n;
+      break;
+    default:
+      result = def;
+      break;
+    }
+  } else {
+    result = def;
+  }
+  return result;
+}
+
 const char *get_param_str(int argc, slib_par_t *params, int n, const char *def) {
   const char *result;
   static char buf[256];

src/platform/teensy/src/module.h

@@ -13,6 +13,7 @@ void error(var_p_t var, const char *field, int nMin, int nMax);
 void error(var_p_t var, const char *field, int n);
 void error(var_p_t var, const char *text);
 int get_param_int(int argc, slib_par_t *params, int n, int def);
+double get_param_num(int argc, slib_par_t *params, int n, double def);
 const char *get_param_str(int argc, slib_par_t *params, int n, const char *def);
 int get_int(var_t *v);
 int get_array_elem_int(var_p_t array, int index);

src/platform/teensy/src/teensy.cpp

@@ -138,8 +138,14 @@ static int cmd_digitalinput_read(var_s *self, int argc, slib_par_t *arg, var_s *
 static int cmd_opendigitalinput(int argc, slib_par_t *args, var_t *retval) {
   int result = 1;
   int pin = get_param_int(argc, args, 0, -1);
+  uint8_t mode = get_param_int(argc, args, 1, 1);
+  if(mode) {
+    mode = INPUT_PULLUP;
+  } else {
+    mode = INPUT;
+  }
   if (is_pin(pin)) {
-    set_pin(retval, pin, INPUT);
+    set_pin(retval, pin, mode);
     v_create_callback(retval, "read", cmd_digitalinput_read);
     result = 1;
   } else {
@@ -174,6 +180,56 @@ static int cmd_opendigitaloutput(int argc, slib_par_t *args, var_t *retval) {
   return result;
 }
 
+static int cmd_analogoutput_write(var_s *self, int argc, slib_par_t *arg, var_s *retval) {
+  if (argc != 1 || !is_pin_object(self)) {
+    error(retval, "AnalogOutput.write", 1);
+    return 0;
+  } else {
+    int pin = self->v.m.id;
+    int value = get_param_int(argc, arg, 0, 0);
+    analogWrite(pin, value);
+  }
+  return 1;
+}
+
+static int cmd_analogoutput_frequency(var_s *self, int argc, slib_par_t *arg, var_s *retval) {
+  if (argc != 1 || !is_pin_object(self)) {
+    error(retval, "AnalogOutput.frequency", 1);
+    return 0;
+  } else {
+    int pin = self->v.m.id;
+    double value = get_param_num(argc, arg, 0, 0.0);
+    analogWriteFrequency(pin, value);
+  }
+  return 1;
+}
+
+static int cmd_analogoutput_resolution(var_s *self, int argc, slib_par_t *arg, var_s *retval) {
+  if (argc != 1 || !is_pin_object(self)) {
+    error(retval, "AnalogOutput.resolution", 1);
+    return 0;
+  } else {
+    int value = get_param_int(argc, arg, 0, 0);
+    analogWriteResolution(value);
+  }
+  return 1;
+}
+
+static int cmd_openanalogoutput(int argc, slib_par_t *args, var_t *retval) {
+  int result;
+  int pin = get_param_int(argc, args, 0, -1);
+  if (is_pin(pin)) {
+    set_pin(retval, pin, OUTPUT);
+    v_create_callback(retval, "write", cmd_analogoutput_write);
+    v_create_callback(retval, "frequency", cmd_analogoutput_frequency);
+    v_create_callback(retval, "resolution", cmd_analogoutput_resolution);
+    result = 1;
+  } else {
+    result = 0;
+  }
+  return result;
+}
+
 static int cmd_get_temperature(int argc, slib_par_t *args, var_t *retval) {
   v_setint(retval, tempmonGetTemp());
   return 1;
@@ -406,10 +462,11 @@ static FuncSpec lib_func[] = {
   {0, 0, "GETTEMP", cmd_get_temperature},
   {0, 0, "GETCPUSPEED", cmd_get_cpu_speed},
   {1, 1, "OPENANALOGINPUT", cmd_openanaloginput},
+  {1, 1, "OPENANALOGOUTPUT", cmd_openanalogoutput},
   {1, 1, "OPENDIGITALINPUT", cmd_opendigitalinput},
   {1, 1, "OPENDIGITALOUTPUT", cmd_opendigitaloutput},
   {0, 1, "OPENSERIAL", cmd_openserial},
-  {0, 1, "OPENI2C", cmd_openi2c}
+  {0, 3, "OPENI2C", cmd_openi2c}
 };
 
 static int teensy_func_count(void) {