PWM channel, frequency, [duty1] [,duty2]
PWM channel, OFF

const struct s_PinDef PinDef[NBRPINS + 1]={
   { 0, 99, "NULL",  UNUSED  ,99},                                                         // pin 0
   { 1,  0, "GP0 ",  DIGITAL_IN | DIGITAL_OUT | UART0TX | SPI0RX | I2C0SDA | PWM0A,99},   // pin 0
{ 2,  1, "GP1 ",  DIGITAL_IN | DIGITAL_OUT | UART0RX | I2C0SCL | PWM0B ,99},     // pin 1
{ 3, 99, "GND ",  UNUSED  ,99},                                                         // pin 2
{ 4,  2, "GP2 ",  DIGITAL_IN | DIGITAL_OUT | SPI0SCK | I2C1SDA | PWM1A ,99},      // pin 3
{ 5,  3, "GP3 ",  DIGITAL_IN | DIGITAL_OUT | SPI0TX | I2C1SCL | PWM1B ,99},     // pin 4
{ 6,  4, "GP4 ",  DIGITAL_IN | DIGITAL_OUT | UART1TX | SPI0RX | I2C0SDA | PWM2A ,99},   // pin 5
{ 7,  5, "GP5 ",  DIGITAL_IN | DIGITAL_OUT | UART1RX | I2C0SCL | PWM2B ,99},     // pin 6
{ 8, 99, "GND ",  UNUSED  ,99},                                                         // pin 7
{ 9,  6, "GP6 ",  DIGITAL_IN | DIGITAL_OUT | SPI0SCK | I2C1SDA | PWM3A ,99},   // pin 8
{ 10,  7, "GP7 ",  DIGITAL_IN | DIGITAL_OUT | SPI0TX | I2C1SCL | EXT_PWM3B ,99}, // pin 9
   { 11,  8, "GP8 ",  DIGITAL_IN | DIGITAL_OUT | UART1TX | SPI1RX | I2C0SDA | PWM4A ,99}, // pin 10
{ 12,  9, "GP9 ",  DIGITAL_IN | DIGITAL_OUT | UART1RX | I2C0SCL | PWM4B ,99},     // pin 11
{ 13, 99, "GND ",  UNUSED  ,99},                                                        // pin 12
{ 14, 10, "GP10",  DIGITAL_IN | DIGITAL_OUT | SPI1SCK | I2C1SDA | PWM5A ,99},   // pin 13
{ 15, 11, "GP11",  DIGITAL_IN | DIGITAL_OUT | SPI1TX | I2C1SCL | PWM5B ,99},       // pin 14
{ 16, 12, "GP12",  DIGITAL_IN | DIGITAL_OUT | UART0TX | SPI1RX | I2C0SDA | PWM6A ,99},  // pin 15
{ 17, 13, "GP13",  DIGITAL_IN | DIGITAL_OUT | UART0RX | I2C0SCL | PWM6B ,99},     // pin 16
{ 18, 99, "GND ", UNUSED  ,99},                                                         // pin 17
{ 19, 14, "GP14",  DIGITAL_IN | DIGITAL_OUT | SPI1SCK | I2C1SDA | PWM7A ,99},     // pin 18
{ 20, 15, "GP15",  DIGITAL_IN | DIGITAL_OUT | SPI1TX | I2C1SCL | PWM7B ,99},   // pin 19

{ 21, 16, "GP16",  DIGITAL_IN | DIGITAL_OUT | UART0TX | SPI0RX | I2C0SDA | PWM0A ,99},  // pin 21
{ 22, 17, "GP17",  DIGITAL_IN | DIGITAL_OUT | UART0RX | I2C0SCL | PWM0B ,99},     // pin 22
{ 23, 99, "GND ",  UNUSED  ,99},                                                        // pin 23
   { 24, 18, "GP18",  DIGITAL_IN | DIGITAL_OUT | SPI0SCK | I2C1SDA | PWM1A ,99}, // pin 24
   { 25, 19, "GP19",  DIGITAL_IN | DIGITAL_OUT | SPI0TX | I2C1SCL | PWM1B ,99},   // pin 25
   { 26, 20, "GP20",  DIGITAL_IN | DIGITAL_OUT | I2C0SDA | PWM2A ,99},            // pin 26
   { 27, 21, "GP21",  DIGITAL_IN | DIGITAL_OUT | I2C0SCL | PWM2B ,99},     // pin 27
{ 28, 99, "GND ",  UNUSED  ,99},                                                        // pin 28
{ 29, 22, "GP22",  DIGITAL_IN | DIGITAL_OUT | PWM3A ,99},             // pin 29
{ 30, 99, "RUN ",  UNUSED  ,99},                                                        // pin 30
   { 31, 26, "GP26",  DIGITAL_IN | DIGITAL_OUT | ANALOG_IN | I2C1SDA | PWM5A , 0 },        // pin 31
   { 32, 27, "GP27",  DIGITAL_IN | DIGITAL_OUT | ANALOG_IN | I2C1SCL | PWM5B , 1 },        // pin 32
{ 33, 99, "AGND", UNUSED  ,99},                                                         // pin 33
{ 34, 28, "GP28",  DIGITAL_IN | DIGITAL_OUT | ANALOG_IN | PWM6A , 2 },                  // pin 34
   { 35, 99, "VREF", UNUSED  ,99},                                                         // pin 35
{ 36, 99, "3V3 ", UNUSED  ,99},                                                         // pin 36
{ 37, 99, "3V3E", UNUSED  ,99},                                                         // pin 37
{ 38, 99, "GND ", UNUSED  ,99},                                                         // pin 38
{ 39, 99, "VSYS", UNUSED  ,99},                                                         // pin 39
{ 40, 99, "VBUS", UNUSED  ,99},                                                         // pin 40
{ 41, 25, "GP25", DIGITAL_OUT | PWM4B  ,99 },                                           // pin 41
};

Option EXPLICIT
Option DEFAULT FLOAT
Const i2caddr=&b1110111
Const MS7=7 'set default wait period
Const signed=1
Const unsigned=0
'
Dim i2cin$ 'max size for integer conversion
Dim UT%,UP%
Dim ac1%,ac2%,ac3,ac4%,ac5%,ac6%,b1%,b2%,mb%,mc%,md% 'bmp180 parameters
Dim x1%,x2%,b5%,b6%,x3,b3%,b4%,b7%,OSS%
Dim temperature%,pressure%
Dim altitude,QNH,pressureinHpa
Dim OSSdata%(4)
Dim OSSscale%(4)
On error skip 1

SetPin 14,i2c1sda
SetPin 15,i2c1scl

I2C2 OPEN 400,1000
init:
 OSS%=1 'set oversampling ratio
' OSS%=0 ' Uncomment this line to check algorithm against datasheet
 OSSdata%(0)=&H34 'commands to sample pressure% with different levels of overs
ampling
 OSSdata%(1)=&H74
 OSSdata%(2)=&Hb4
 OSSdata%(3)=&HF4
 OSSscale%(0)=1 'scale factors for calcs when oversampled
 OSSscale%(1)=2
 OSSscale%(2)=4
 OSSscale%(3)=8
'
 I2C2 WRITE i2caddr,1,1,&HAA 'send read calibration data command
 I2C2 READ i2caddr,0,22,i2cin$ 'read in calibration data
 ac1%=Str2bin(int16,Mid$(i2cin$,1,2),big)
 ac2%=Str2bin(int16,Mid$(i2cin$,3,2),big)
 ac3=Str2bin(int16,Mid$(i2cin$,5,2),big)
 ac4%=Str2bin(uint16,Mid$(i2cin$,7,2),big)
 ac5%=Str2bin(uint16,Mid$(i2cin$,9,2),big)
 ac6%=Str2bin(uint16,Mid$(i2cin$,11,2),big)
 b1%=Str2bin(int16,Mid$(i2cin$,13,2),big)
 b2%=Str2bin(int16,Mid$(i2cin$,15,2),big)
 mb%=Str2bin(int16,Mid$(i2cin$,17,2),big)
 mc%=Str2bin(int16,Mid$(i2cin$,19,2),big)
 md%=Str2bin(int16,Right$(i2cin$,2),big)
'
' Uncomment this block to check algorithm against datasheet
'
'  ac1%=408
'  ac2%=-72
'  AC3=-14383
'  ac4%=32741
'  ac5%=32757
'  ac6%=23153
'  b1%=6190
'  b2%=4
'  mb%=-32768
'  mc%=-8711
'  md%=2868
main:
 I2C2 WRITE i2caddr,0,2,&HF4,&H2E 'send temp conversion
 Pause MS7 'wait for temperature% conversion
 I2C2 WRITE i2caddr,1,1,&HF6 'send read data
 I2C2 READ i2caddr,0,2,i2cin$ 'read 2 bytes
 UT%=Str2bin(uint16,i2cin$,big)
'  UT%=27898 ' Uncomment this line to check algorithm against datasheet
 I2C2 WRITE i2caddr,0,2,&HF4,ossdata%(oss%) 'send pressure% conversion
 Pause (oss%+1)*ms7 'wait for the p  ressure% conversion
 I2C2 WRITE i2caddr,1,1,&HF6 'send read data
 I2C2 READ i2caddr,0,3,i2cin$ 'read 3 bytes
 UP%=Str2bin(uint32,Chr$(0)+i2cin$,big)
 UP%=UP%>>(8-oss%) 'scale the oUT%pUT% by the numb%er of unused bits in the xl
sb byte
'  UP%=23843' Uncomment this line to check algorithm against datasheet
 calc_temp()
 calc_pressure()
 pressureinHpa=pressure%/100
 Print "Temperature = ",Str$(temperature%/10,4,1)," Deg C"
 Print "Local pressure = ",Str$(pressure%/100,4,1)," Hectopascal/mb"
 Input "QNH in Hpa/Mb  ? ",QNH
 altitude=calcaltitude(QNH,pressureinHpa)
 Print "Current altitude in feet = ",altitude
 Print "Reverse calculate Sea level pressure = ",calcQNH(altitude,pressureinHp
a)," Hectopascal/mb"
End
'
' calc_temperature%: calculate the temperature% from the raw temperature% given
the calibration parameters
'
Sub calc_temp
 x1%=(UT%-ac6%)*ac5%\powerof2(15)
 x2%=mc%*powerof2(11)/(x1%+md%) 'This needs to be a floating divide to match t
he datasheet
 b5%=x1%+x2%
 temperature%=(b5%+8)\powerof2(4)
End Sub
'
' calc_pressure: calculate the pressure% from the raw pressure% given the calib
ration parameters and temperature% oUT%pUT%
'
Sub calc_pressure
  b6%=b5%-4000
  x1%=(b2%*(b6%*b6%/powerof2(12)))\powerof2(11)
  x2%=ac2%*b6%\powerof2(11)
  x3=x1%+x2%
  b3%=(((ac1%*4+x3)*ossscale%(oss%))+2)\4
  x1%=AC3*b6%\POWEROF2(13)
  x2%=(b1%*(b6%*b6%/POWEROF2(12)))\POWEROF2(16)
  x3=((x1%+x2%)+2)\4
  b4%=ac4%*(Abs(x3+32768))\powerof2(15)
  b7%=Abs(UP%-b3%)*(50000\ossscale%(oss%))
  pressure%=(b7%*2)\b4%
  x1%=(pressure%\powerof2(8))*(pressure%\powerof2(8))
  x1%=(x1%*3038)\powerof2(16)
  x2%=(-7357*pressure%)\powerof2(16)
  pressure%=pressure%+(x1%+x2%+3791)\powerof2(4)
  End Sub
'
Function calcQNH(currentaltitude,localpressure)
 calcQNH=(localpressure*100)/((1-(currentaltitude*0.3048/44330))^5.255)/100
End Function
'
Function log10(x)
 log10=Log(x)/2.302585093
End Function
'
Function calcaltitude(sealevelpressure, localpressure)
 Local a As float, b As float
 calcaltitude=((10^(log10(localpressure/sealevelpressure)/5.2558797))-1)/-6.87
55856  *1000000
End Function


'
Function powerof2(i As integer) As integer
powerof2=(1<<i)
End Function