{{ ***************************************** * Memsic 2125 Driver v1.2 * * Author: Beau Schwabe * * Copyright (c) 2006 - 2009 Parallax * * See end of file for terms of use. * ***************************************** History: Version 1.0 - (07-31-2006) original release Version 1.1 - (08-17-2008) modified code to return RAW x and y values Version 1.2 - (12-18-2009) Added X and Y Tilt values }} { ┌──────────┐ Tout ──│1 6│── VDD │ ┌────┐ │ Yout ──│2 │ /\ │ 5│── Xout │ │/ \│ │ VSS ──│3 └────┘ 4│── VSS └──────────┘ } VAR long cog long offset long scale long calflag '5 contiguous longs long _ro long _theta long _xraw long _yraw PUB start(xpin, ypin) : okay '' Start driver - starts a cog '' returns false if no cog available '' '' xpin = x input signal '' ypin = y input signal '' stop offset := 90 * (clkfreq / 200) 'offset value for Tilt conversion scale := clkfreq / 800 'scale value for Tilt conversion ctra_value := $6800_0000 + xpin ctrb_value := $6800_0000 + ypin mask_value := |