Change-Id: I8eaf3151b1d405799eb582564f0e1e8fbcb7744c Signed-off-by: Ricky Barrette <rickbarrette@gmail.com>
180 lines
4.7 KiB
Java
180 lines
4.7 KiB
Java
/*
|
|
* Copyright 2011 Ytai Ben-Tsvi. All rights reserved.
|
|
*
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without modification, are
|
|
* permitted provided that the following conditions are met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above copyright notice, this list of
|
|
* conditions and the following disclaimer.
|
|
*
|
|
* 2. Redistributions in binary form must reproduce the above copyright notice, this list
|
|
* of conditions and the following disclaimer in the documentation and/or other materials
|
|
* provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND
|
|
* FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ARSHAN POURSOHI OR
|
|
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
|
|
* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
|
* ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
|
|
* ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
* The views and conclusions contained in the software and documentation are those of the
|
|
* authors and should not be interpreted as representing official policies, either expressed
|
|
* or implied.
|
|
*/
|
|
package ioio.lib.impl;
|
|
|
|
import ioio.lib.api.AnalogInput;
|
|
import ioio.lib.api.exception.ConnectionLostException;
|
|
import ioio.lib.impl.IncomingState.InputPinListener;
|
|
|
|
import java.io.IOException;
|
|
|
|
class AnalogInputImpl extends AbstractPin implements AnalogInput,
|
|
InputPinListener {
|
|
private int value_;
|
|
private boolean valid_ = false;
|
|
|
|
short[] buffer_;
|
|
int bufferSize_;
|
|
int bufferCapacity_;
|
|
int bufferReadCursor_;
|
|
int bufferWriteCursor_;
|
|
int bufferOverflowCount_ = 0;
|
|
|
|
AnalogInputImpl(IOIOImpl ioio, int pin) throws ConnectionLostException {
|
|
super(ioio, pin);
|
|
}
|
|
|
|
@Override
|
|
public float getVoltage() throws InterruptedException,
|
|
ConnectionLostException {
|
|
return read() * getReference();
|
|
}
|
|
|
|
@Override
|
|
public float getReference() {
|
|
return 3.3f;
|
|
}
|
|
|
|
@Override
|
|
synchronized public void setValue(int value) {
|
|
// Log.v("AnalogInputImpl", "Pin " + pinNum_ + " value is " + value);
|
|
assert (value >= 0 && value < 1024);
|
|
value_ = value;
|
|
if (!valid_) {
|
|
valid_ = true;
|
|
notifyAll();
|
|
}
|
|
bufferPush((short) value);
|
|
}
|
|
|
|
@Override
|
|
synchronized public float read() throws InterruptedException,
|
|
ConnectionLostException {
|
|
checkState();
|
|
while (!valid_ && state_ == State.OPEN) {
|
|
wait();
|
|
}
|
|
checkState();
|
|
return (float) value_ / 1023.0f;
|
|
}
|
|
|
|
@Override
|
|
public synchronized void disconnected() {
|
|
super.disconnected();
|
|
notifyAll();
|
|
}
|
|
|
|
@Override
|
|
public synchronized void close() {
|
|
super.close();
|
|
try {
|
|
ioio_.protocol_.setAnalogInSampling(pinNum_, false);
|
|
} catch (IOException e) {
|
|
}
|
|
}
|
|
|
|
@Override
|
|
public synchronized void setBuffer(int capacity)
|
|
throws ConnectionLostException {
|
|
checkState();
|
|
if (capacity <= 0) {
|
|
buffer_ = null;
|
|
} else {
|
|
buffer_ = new short[capacity];
|
|
}
|
|
bufferCapacity_ = capacity;
|
|
bufferSize_ = 0;
|
|
bufferReadCursor_ = 0;
|
|
bufferWriteCursor_ = 0;
|
|
bufferOverflowCount_ = 0;
|
|
}
|
|
|
|
@Override
|
|
public float readBuffered() throws InterruptedException,
|
|
ConnectionLostException {
|
|
checkState();
|
|
return (float) bufferPull() / 1023.0f;
|
|
}
|
|
|
|
@Override
|
|
public float getVoltageBuffered() throws InterruptedException,
|
|
ConnectionLostException {
|
|
return readBuffered() * getReference();
|
|
}
|
|
|
|
private void bufferPush(short value) {
|
|
if (buffer_ == null) {
|
|
return;
|
|
}
|
|
if (bufferSize_ == bufferCapacity_) {
|
|
++bufferOverflowCount_;
|
|
} else {
|
|
++bufferSize_;
|
|
}
|
|
buffer_[bufferWriteCursor_++] = value;
|
|
if (bufferWriteCursor_ == bufferCapacity_) {
|
|
bufferWriteCursor_ = 0;
|
|
}
|
|
notifyAll();
|
|
}
|
|
|
|
private synchronized short bufferPull() throws InterruptedException,
|
|
ConnectionLostException {
|
|
if (buffer_ == null) {
|
|
throw new IllegalStateException(
|
|
"Need to call setBuffer() before reading buffered values.");
|
|
}
|
|
while (bufferSize_ == 0 && state_ == State.OPEN) {
|
|
wait();
|
|
}
|
|
checkState();
|
|
short result = buffer_[bufferReadCursor_++];
|
|
if (bufferReadCursor_ == bufferCapacity_) {
|
|
bufferReadCursor_ = 0;
|
|
}
|
|
--bufferSize_;
|
|
return result;
|
|
}
|
|
|
|
@Override
|
|
public int getOverflowCount() throws ConnectionLostException {
|
|
return bufferOverflowCount_;
|
|
}
|
|
|
|
@Override
|
|
public float getSampleRate() throws ConnectionLostException {
|
|
return 1000.0f;
|
|
}
|
|
|
|
@Override
|
|
public int available() throws ConnectionLostException {
|
|
return bufferSize_;
|
|
}
|
|
}
|