-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathmindsensors-rcxsensorsmux-test1.c
70 lines (55 loc) · 1.98 KB
/
mindsensors-rcxsensorsmux-test1.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
#pragma config(Sensor, S1, MSRXMUX, sensorI2CCustom9V)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
/*
* $Id: mindsensors-rcxsensorsmux-test1.c 133 2013-03-10 15:15:38Z xander $
*/
/**
* mindsensors-rcxsensorsmux.h provides an API for the Mindsensors RCX Sensor MUX Sensor. This program
* demonstrates how to use that API.
*
* Changelog:
* - 0.1: Initial release
* - 0.2: More comments
*
* Credits:
* - Big thanks to Mindsensors for providing me with the hardware necessary to write and test this.
*
* License: You may use this code as you wish, provided you give credit where it's due.
*
* THIS CODE WILL ONLY WORK WITH ROBOTC VERSION 3.59 AND HIGHER.
* Xander Soldaat (xander_at_botbench.com)
* 28 November 2009
* version 0.2
*/
#include "drivers/mindsensors-rcxsensorsmux.h"
task main () {
int chan1 = 0;
int chan2 = 0;
int chan4 = 0;
nxtDisplayCenteredTextLine(0, "Mindsensors");
nxtDisplayCenteredBigTextLine(1, "RXMUX");
nxtDisplayCenteredTextLine(3, "Test 1");
wait1Msec(2000);
// Set up channel 1 on the RCX sensor MUX to a light sensor in percentage mode
MSRXMUXsetupChan(MSRXMUX, 1, sensorReflection, modePercentage, 5);
// Set up channel 2 on the RCX sensor MUX to a touch sensor in raw mode
MSRXMUXsetupChan(MSRXMUX, 2, sensorTouch, modeRaw, 5);
// Set up channel 4 on the RCX sensor MUX to rotation sensor in rotation mode
MSRXMUXsetupChan(MSRXMUX, 4, sensorRotation, modeRotation, 5);
while(true) {
// Read from the channels and display
chan1 = MSRXMUXreadChan(MSRXMUX, 1);
chan2 = MSRXMUXreadChan(MSRXMUX, 2);
chan4 = MSRXMUXreadChan(MSRXMUX, 4);
nxtDisplayBigTextLine(1, "%d", chan1);
nxtDisplayBigTextLine(3, "%d", chan2);
nxtDisplayBigTextLine(5, "%d", chan4);
}
PlaySound(soundBeepBeep);
while(bSoundActive) EndTimeSlice();
eraseDisplay();
while(1) EndTimeSlice();
}
/*
* $Id: mindsensors-rcxsensorsmux-test1.c 133 2013-03-10 15:15:38Z xander $
*/