10 for i=1 to 100
20 setpin 8,10,2000,i
30 pause 100
40 next

/*********************************************************** ************************************************************
MMBasic

custom.c

Handles all the custom commands and functions in MMBasic. These are commands and functions that are not
normally part of the core BASIC language. This is a good place to insert your own customised commands.

Copyright 2011 Geoff Graham - http://geoffg.net
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/>.

************************************************************ ************************************************************ /

#include <p32xxxx.h> // device specific defines
#include <plib.h> // peripheral libraries

#define INCLUDE_FUNCTION_DEFINES
#include "Maximite.h"
#include "MMBasic.h"
#include "Operators.h"
#include "Commands.h"
#include "External.h"
#include "Misc.h"
#include "Files.h"
#include "Custom.h"


/*********************************************************** ************************************************************ *********************
custom commands and functions
each function is responsible for decoding a command
all function names are in the form cmd_xxxx() (for a basic command) or fun_xxxx() (for a basic function) so, if you want to search for the
function responsible for the NAME command look for cmd_name

There are 4 items of information that are setup before the command is run.
All these are globals.

int cmdtoken This is the token number of the command (some commands can handle multiple
statement types and this helps them differentiate)

char *cmdline This is the command line terminated with a zero char and trimmed of leading
spaces. It may exist anywhere in memory (or even ROM).

char *nextstmt This is a pointer to the next statement to be executed. The only thing a
command can do with it is save it or change it to some other location.

int CurrentLineNbr This is read only and is set to zero if the command is in immediate mode.

The only actions a command can do to change the program flow is to change nextstmt or
execute longjmp(mark, 1) if it wants to abort the program.

******************** ************************************************************ ************************************************************ /

void cmd_pwm(void) {
static unsigned int pwm_enabled, pwm_freq;
unsigned int freq, pwm;

getargs(&cmdline, 3, ",");
if (argc != 3) error("Invalid syntax");
freq = getinteger(argv[0]);
if (freq == 0) {
OC1CONCLR = 0x0000ffff; // Disable the output compare module
T2CONCLR = 0x0000ffff; // Disable timer 2 module
pwm_enabled = 0;
pwm_freq = 0;
return;
}
if (freq < 5 || freq > 800000) error("Invalid frequency (must be 5 - 800000, or 0 to disable)");
pwm = getinteger(argv[2]);
if (pwm < 0 || pwm > 100) error("Invalid PWM (must be 0 - 100)");
if (!pwm_enabled || pwm_freq != freq) {
pwm_enabled = 0;
pwm_freq = freq; // Save current frequency
OC1CONCLR = 0x0000ffff; // Disable the output compare module
T2CONCLR = 0x0000ffff; // Disable timer 2 module
if (freq >= 1280) {}
else if (freq >= 640) {freq <<= 1; T2CONSET = 0x00000010;}
else if (freq >= 320) {freq <<= 2; T2CONSET = 0x00000020;}
else if (freq >= 160) {freq <<= 3; T2CONSET = 0x00000030;}
else if (freq >= 80) {freq <<= 4; T2CONSET = 0x00000040;}
else if (freq >= 40) {freq <<= 5; T2CONSET = 0x00000050;}
else if (freq >= 20) {freq <<= 6; T2CONSET = 0x00000060;}
else {freq <<= 8; T2CONSET = 0x00000070;}
TMR2 = 0; // Clear timer 2 counter
PR2 = ((BUSFREQ + (freq >> 1)) / freq) - 1; // Set timer 2 period
}
OC1RS = ((pwm * (PR2 + 1)) + 50) / 100; // Set duty period
if (!pwm_enabled) {
pwm_enabled = 1;
OC1R = OC1RS; // Set initial duty period
OC1CON = 0x00000006; // Enable PWM mode
OC1CONSET = 0x00008000; // Enable output compare module
T2CONSET = 0x00008000; // Enable timer 2
}
}

/*********************************************************** ************************************************************
MMBasic

custom.h

Include file that contains the globals and defines for custom.c in MMBasic.

Copyright 2011 Geoff Graham - http://geoffg.net
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/>.

************************************************************ ************************************************************ /



/*********************************************************** ***********************
All command tokens tokens (eg, PRINT, FOR, etc) should be inserted in this table
************************************************************ **********************/
#ifdef INCLUDE_COMMAND_TABLE
// the format is:
// TEXT TYPE P FUNCTION TO CALL
// where type is always T_CMD
// and P is the precedence (which is only used for operators and not commands)

{ "PWM", T_CMD, 0, cmd_pwm },

#endif


/*********************************************************** ***********************
All other tokens (keywords, functions, operators) should be inserted in this table
************************************************************ **********************/
#ifdef INCLUDE_TOKEN_TABLE
// the format is:
// TEXT TYPE P FUNCTION TO CALL
// where type is T_NA, T_FUN, T_FNA or T_OPER argumented by the types T_STR and/or T_NBR
// and P is the precedence (which is only used for operators)

#endif

/*********************************************************** ***********************
the C language function associated with commands, functions or operators should be
declared here
Also general definitions used by other modules
************************************************************ **********************/
#ifdef INCLUDE_FUNCTION_DEFINES

#ifndef CUSTOM_HEADER
#define CUSTOM_HEADER

// format:
// void cmd_???(void)
// void fun_???(void)
// void op_???(void)

void cmd_pwm(void);

#endif
#endif

/*********************************************************** ************************************************************
MMBasic

custom.c

Handles all the custom commands and functions in MMBasic. These are commands and functions that are not
normally part of the core BASIC language. This is a good place to insert your own customised commands.

Copyright 2011 Geoff Graham - http://geoffg.net
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/>.

************************************************************ ************************************************************ /

#include <p32xxxx.h> // device specific defines
#include <plib.h> // peripheral libraries

#define INCLUDE_FUNCTION_DEFINES
#include "Maximite.h"
#include "MMBasic.h"
#include "Operators.h"
#include "Commands.h"
#include "External.h"
#include "Misc.h"
#include "Files.h"
#include "Custom.h"


/*********************************************************** ************************************************************ *********************
custom commands and functions
each function is responsible for decoding a command
all function names are in the form cmd_xxxx() (for a basic command) or fun_xxxx() (for a basic function) so, if you want to search for the
function responsible for the NAME command look for cmd_name

There are 4 items of information that are setup before the command is run.
All these are globals.

int cmdtoken This is the token number of the command (some commands can handle multiple
statement types and this helps them differentiate)

char *cmdline This is the command line terminated with a zero char and trimmed of leading
spaces. It may exist anywhere in memory (or even ROM).

char *nextstmt This is a pointer to the next statement to be executed. The only thing a
command can do with it is save it or change it to some other location.

int CurrentLineNbr This is read only and is set to zero if the command is in immediate mode.

The only actions a command can do to change the program flow is to change nextstmt or
execute longjmp(mark, 1) if it wants to abort the program.

******************** ************************************************************ ************************************************************ /

static unsigned int pwm_enabled, pwm_freq;
void cmd_pwm(void) {
unsigned int module, freq, pwm;

getargs(&cmdline, 5, ",");
if (argc != 5) error("Invalid syntax");
module = getinteger(argv[0]);
if (module != 1 && module != 4) error("Output Compare module must be 1 or 4");
freq = getinteger(argv[2]);
if (freq == 0) {
if (module == 1) OC1CONCLR = 0x0000ffff; // Disable output compare module 1
else OC4CONCLR = 0x0000ffff; // Disable output compare module 4
pwm_enabled &= ~module;
if (!pwm_enabled) {
pwm_freq = 0; // Clear saved frequency
T2CONCLR = 0x0000ffff; // Disable timer 2 module
}
return;
}
if (freq < 5 || freq > 800000) error("Invalid frequency (must be 5 - 800000, or 0 to disable)");
pwm = getinteger(argv[4]);
if (pwm < 0 || pwm > 100) error("Invalid PWM (must be 0 - 100)");
if (pwm_freq != freq) {
if (pwm_enabled & ~module) error("Cannot change frequency when other PWM output is enabled");
pwm_enabled = 0; // Clear status byte
pwm_freq = freq; // Save current frequency
OC1CONCLR = 0x0000ffff; // Disable output compare module 1
OC4CONCLR = 0x0000ffff; // Disable output compare module 4
T2CONCLR = 0x0000ffff; // Disable timer 2 module
if (freq >= 1280) {}
else if (freq >= 640) {freq <<= 1; T2CONSET = 0x00000010;}
else if (freq >= 320) {freq <<= 2; T2CONSET = 0x00000020;}
else if (freq >= 160) {freq <<= 3; T2CONSET = 0x00000030;}
else if (freq >= 80) {freq <<= 4; T2CONSET = 0x00000040;}
else if (freq >= 40) {freq <<= 5; T2CONSET = 0x00000050;}
else if (freq >= 20) {freq <<= 6; T2CONSET = 0x00000060;}
else {freq <<= 8; T2CONSET = 0x00000070;}
TMR2 = 0; // Clear timer 2 counter
PR2 = ((BUSFREQ + (freq >> 1)) / freq) - 1; // Set timer 2 period
}
if (module == 1) OC1RS = ((pwm * (PR2 + 1)) + 50) / 100; // Set duty period for output compare module 1
else OC4RS = ((pwm * (PR2 + 1)) + 50) / 100; // Set duty period for output compare module 4
if (!(pwm_enabled & module)) {
pwm_enabled |= module;
if (module == 1) {
OC1R = OC1RS; // Set initial duty period for output compare module 1
OC1CON = 0x00000006; // Enable PWM mode on output compare module 1
OC1CONSET = 0x00008000; // Enable output compare module 1
} else {
OC4R = OC1RS; // Set initial duty period for output compare module 4
OC4CON = 0x00000006; // Enable PWM mode on output compare module 4
OC4CONSET = 0x00008000; // Enable output compare module 4
}
if (pwm_enabled == module) T2CONSET = 0x00008000; // Enable timer 2
}
}


void pwm_disable() {
pwm_enabled = 0; // Clear status bits
pwm_freq = 0; // Clear current frequency
OC1CONCLR = 0x0000ffff; // Disable output compare module 1
OC4CONCLR = 0x0000ffff; // Disable output compare module 4
T2CONCLR = 0x0000ffff; // Disable timer 2 module
}