Svenska ElektronikForumet

Kod: Markera allt

//
// CNC Tool-Sensor-1 firmware v1.0 for PIC10F222
//
// Copyright (c) Mats Byggmästar Consulting Ab 2008
//
// Programming the chip with XWisp & Wisp648 from http://www.voti.nl:
//   c:\>xwisp target 10f222 go ToolSensor.hex
//
// References:
//   [1] MICROCHIP PIC10F220/222 Data Sheet (DS41270E)
//   [2] MICROCHIP PIC10F220/222 Memory Programming Specification (DS41266C)
//

#include <pic.h>
#include "delay.h"

// Configuration word (See [2] 4.0 CONFIGURATION WORD)
// Disable MCLR pin function, we need it as digital input GP3
// Disable MCLR pull-up
__CONFIG(OSC_4MHZ & MCPUDIS & WDTDIS & UNPROTECT & MCLRDIS);

void main()
{
	// Setup options (See [1] 4.5 OPTION Register)
	// Defaults are okay: Weak pull-ups on GP0,GP1,GP3. T0CKI pin disabled
	OPTION = 0;

	// Oscillator calibration (See [1] 4.6 OSCCAL Register)
	// Frequency not critical: set center frequency
	OSCCAL = 0;

	// Make GP0,GP1,GP2 digital I/O (See [1] TABLE 5-2)
	FOSC4 = 0;	// Disable FOSC4 on GP2
	ANS0 = 0;   // Disable A/D on GP0
	ANS1 = 0;   // Disable A/D on GP1

	// Select directions for GP0,GP1,GP2,GP3 (See [1] 5.2 TRIS Registers)
	// GP2 have no internal pull-up, so use it as output. GP3 is hardwired as input
	// GP2=0(output), GP0,GP1,GP3=1(input)
	TRISGPIO = 0b00001011;

	// Set output low
	GP2 = 0;

	// Wait for things to settle before doing self-test
	DelayMs(250);

	// Self-test: Check that GP0, GP1 and GP3 are all low, i.e. that they 
	// all make contact with the sensor plate
	if ((GPIO & 0b00001011) != 0)
	{
		// Error in at least one contact (oxidation?), tool sensor is not safe to use
		// --> flash output (LED) forever
		for (;;)
		{
			GP2 = 1;
			DelayMs(250);
			GP2 = 0;
			DelayMs(250);
		}
	}

	// Selftest was okay, run mainloop:
	for (;;)
	{
		// Loop while tool NOT pusing down sensor plate
		while ((GPIO & 0b00001011) == 0)
		{
			// Busy wait
		}

		// Tool pushed down sensor plate, set output high for 250 ms
		GP2 = 1;
		DelayMs(250);
		GP2 = 0;

		// Loop while tool is still pushing down sensor plate
		while ((GPIO & 0b00001011) != 0)
		{
			// Busy wait
		}

		// Tool retracted from sensor plate, wait for contact bounce to settle
		DelayMs(250);
	}
}