use byteorder::ReadBytesExt;
use error::{Error, Result, UnsupportedFeature};
use huffman::{fill_default_mjpeg_tables, HuffmanDecoder, HuffmanTable};
use marker::Marker;
use parser::{AdobeColorTransform, AppData, CodingProcess, Component, Dimensions, EntropyCoding, FrameInfo,
parse_app, parse_com, parse_dht, parse_dqt, parse_dri, parse_sof, parse_sos, ScanInfo};
use upsampler::Upsampler;
use std::cmp;
use std::io::Read;
use std::mem;
use std::ops::Range;
use std::sync::Arc;
use worker::{RowData, PlatformWorker, Worker};
pub const MAX_COMPONENTS: usize = 4;
static UNZIGZAG: [u8; 64] = [
0, 1, 8, 16, 9, 2, 3, 10,
17, 24, 32, 25, 18, 11, 4, 5,
12, 19, 26, 33, 40, 48, 41, 34,
27, 20, 13, 6, 7, 14, 21, 28,
35, 42, 49, 56, 57, 50, 43, 36,
29, 22, 15, 23, 30, 37, 44, 51,
58, 59, 52, 45, 38, 31, 39, 46,
53, 60, 61, 54, 47, 55, 62, 63,
];
#[derive(Clone, Copy, Debug, PartialEq)]
pub enum PixelFormat {
L8,
RGB24,
CMYK32,
}
#[derive(Clone, Copy, Debug, PartialEq)]
pub struct ImageInfo {
pub width: u16,
pub height: u16,
pub pixel_format: PixelFormat,
}
pub struct Decoder<R> {
reader: R,
frame: Option<FrameInfo>,
dc_huffman_tables: Vec<Option<HuffmanTable>>,
ac_huffman_tables: Vec<Option<HuffmanTable>>,
quantization_tables: [Option<Arc<[u16; 64]>>; 4],
restart_interval: u16,
color_transform: Option<AdobeColorTransform>,
is_jfif: bool,
is_mjpeg: bool,
coefficients: Vec<Vec<i16>>,
coefficients_finished: [u64; MAX_COMPONENTS],
}
impl<R: Read> Decoder<R> {
pub fn new(reader: R) -> Decoder<R> {
Decoder {
reader: reader,
frame: None,
dc_huffman_tables: vec![None, None, None, None],
ac_huffman_tables: vec![None, None, None, None],
quantization_tables: [None, None, None, None],
restart_interval: 0,
color_transform: None,
is_jfif: false,
is_mjpeg: false,
coefficients: Vec::new(),
coefficients_finished: [0; MAX_COMPONENTS],
}
}
pub fn info(&self) -> Option<ImageInfo> {
match self.frame {
Some(ref frame) => {
let pixel_format = match frame.components.len() {
1 => PixelFormat::L8,
3 => PixelFormat::RGB24,
4 => PixelFormat::CMYK32,
_ => panic!(),
};
Some(ImageInfo {
width: frame.image_size.width,
height: frame.image_size.height,
pixel_format: pixel_format,
})
},
None => None,
}
}
pub fn read_info(&mut self) -> Result<()> {
self.decode_internal(true).map(|_| ())
}
pub fn decode(&mut self) -> Result<Vec<u8>> {
self.decode_internal(false)
}
fn decode_internal(&mut self, stop_after_metadata: bool) -> Result<Vec<u8>> {
if stop_after_metadata && self.frame.is_some() {
return Ok(Vec::new());
}
else if self.frame.is_none() && (self.reader.read_u8()? != 0xFF || Marker::from_u8(self.reader.read_u8()?) != Some(Marker::SOI)) {
return Err(Error::Format("first two bytes is not a SOI marker".to_owned()));
}
let mut previous_marker = Marker::SOI;
let mut pending_marker = None;
let mut worker = None;
let mut scans_processed = 0;
let mut planes = vec![Vec::new(); self.frame.as_ref().map_or(0, |frame| frame.components.len())];
loop {
let marker = match pending_marker.take() {
Some(m) => m,
None => self.read_marker()?,
};
match marker {
Marker::SOF(..) => {
if self.frame.is_some() {
return Err(Error::Unsupported(UnsupportedFeature::Hierarchical));
}
let frame = parse_sof(&mut self.reader, marker)?;
let component_count = frame.components.len();
if frame.is_differential {
return Err(Error::Unsupported(UnsupportedFeature::Hierarchical));
}
if frame.coding_process == CodingProcess::Lossless {
return Err(Error::Unsupported(UnsupportedFeature::Lossless));
}
if frame.entropy_coding == EntropyCoding::Arithmetic {
return Err(Error::Unsupported(UnsupportedFeature::ArithmeticEntropyCoding));
}
if frame.precision != 8 {
return Err(Error::Unsupported(UnsupportedFeature::SamplePrecision(frame.precision)));
}
if frame.image_size.height == 0 {
return Err(Error::Unsupported(UnsupportedFeature::DNL));
}
if component_count != 1 && component_count != 3 && component_count != 4 {
return Err(Error::Unsupported(UnsupportedFeature::ComponentCount(component_count as u8)));
}
let _ = Upsampler::new(&frame.components, frame.image_size.width, frame.image_size.height)?;
self.frame = Some(frame);
if stop_after_metadata {
return Ok(Vec::new());
}
planes = vec![Vec::new(); component_count];
},
Marker::SOS => {
if self.frame.is_none() {
return Err(Error::Format("scan encountered before frame".to_owned()));
}
if worker.is_none() {
worker = Some(PlatformWorker::new()?);
}
let frame = self.frame.clone().unwrap();
let scan = parse_sos(&mut self.reader, &frame)?;
if frame.coding_process == CodingProcess::DctProgressive && self.coefficients.is_empty() {
self.coefficients = frame.components.iter().map(|c| {
let block_count = c.block_size.width as usize * c.block_size.height as usize;
vec![0; block_count * 64]
}).collect();
}
if scan.successive_approximation_low == 0 {
for &i in scan.component_indices.iter() {
for j in scan.spectral_selection.clone() {
self.coefficients_finished[i] |= 1 << j;
}
}
}
let is_final_scan = scan.component_indices.iter().all(|&i| self.coefficients_finished[i] == !0);
let (marker, data) = self.decode_scan(&frame, &scan, worker.as_mut().unwrap(), is_final_scan)?;
if let Some(data) = data {
for (i, plane) in data.into_iter().enumerate().filter(|&(_, ref plane)| !plane.is_empty()) {
planes[i] = plane;
}
}
pending_marker = marker;
scans_processed += 1;
},
Marker::DQT => {
let tables = parse_dqt(&mut self.reader)?;
for (i, &table) in tables.into_iter().enumerate() {
if let Some(table) = table {
let mut unzigzagged_table = [0u16; 64];
for j in 0 .. 64 {
unzigzagged_table[UNZIGZAG[j] as usize] = table[j];
}
self.quantization_tables[i] = Some(Arc::new(unzigzagged_table));
}
}
},
Marker::DHT => {
let is_baseline = self.frame.as_ref().map(|frame| frame.is_baseline);
let (dc_tables, ac_tables) = parse_dht(&mut self.reader, is_baseline)?;
let current_dc_tables = mem::replace(&mut self.dc_huffman_tables, vec![]);
self.dc_huffman_tables = dc_tables.into_iter()
.zip(current_dc_tables.into_iter())
.map(|(a, b)| a.or(b))
.collect();
let current_ac_tables = mem::replace(&mut self.ac_huffman_tables, vec![]);
self.ac_huffman_tables = ac_tables.into_iter()
.zip(current_ac_tables.into_iter())
.map(|(a, b)| a.or(b))
.collect();
},
Marker::DAC => return Err(Error::Unsupported(UnsupportedFeature::ArithmeticEntropyCoding)),
Marker::DRI => self.restart_interval = parse_dri(&mut self.reader)?,
Marker::COM => {
let _comment = parse_com(&mut self.reader)?;
},
Marker::APP(..) => {
if let Some(data) = parse_app(&mut self.reader, marker)? {
match data {
AppData::Adobe(color_transform) => self.color_transform = Some(color_transform),
AppData::Jfif => {
self.is_jfif = true;
},
AppData::Avi1 => self.is_mjpeg = true,
}
}
},
Marker::RST(..) => {
if previous_marker != Marker::SOS {
return Err(Error::Format("RST found outside of entropy-coded data".to_owned()));
}
},
Marker::DNL => {
if previous_marker != Marker::SOS || scans_processed != 1 {
return Err(Error::Format("DNL is only allowed immediately after the first scan".to_owned()));
}
return Err(Error::Unsupported(UnsupportedFeature::DNL));
},
Marker::DHP | Marker::EXP => return Err(Error::Unsupported(UnsupportedFeature::Hierarchical)),
Marker::EOI => break,
_ => return Err(Error::Format(format!("{:?} marker found where not allowed", marker))),
}
previous_marker = marker;
}
if planes.is_empty() || planes.iter().any(|plane| plane.is_empty()) {
return Err(Error::Format("no data found".to_owned()));
}
let frame = self.frame.as_ref().unwrap();
compute_image(&frame.components, &planes, frame.image_size, self.is_jfif, self.color_transform)
}
fn read_marker(&mut self) -> Result<Marker> {
while self.reader.read_u8()? != 0xFF {}
let mut byte = self.reader.read_u8()?;
while byte == 0xFF {
byte = self.reader.read_u8()?;
}
match byte {
0x00 => Err(Error::Format("FF 00 found where marker was expected".to_owned())),
_ => Ok(Marker::from_u8(byte).unwrap()),
}
}
fn decode_scan(&mut self,
frame: &FrameInfo,
scan: &ScanInfo,
worker: &mut PlatformWorker,
produce_data: bool)
-> Result<(Option<Marker>, Option<Vec<Vec<u8>>>)> {
assert!(scan.component_indices.len() <= MAX_COMPONENTS);
let components: Vec<Component> = scan.component_indices.iter()
.map(|&i| frame.components[i].clone())
.collect();
if components.iter().any(|component| self.quantization_tables[component.quantization_table_index].is_none()) {
return Err(Error::Format("use of unset quantization table".to_owned()));
}
if self.is_mjpeg {
fill_default_mjpeg_tables(scan, &mut self.dc_huffman_tables, &mut self.ac_huffman_tables);
}
if scan.spectral_selection.start == 0 &&
scan.dc_table_indices.iter().any(|&i| self.dc_huffman_tables[i].is_none()) {
return Err(Error::Format("scan makes use of unset dc huffman table".to_owned()));
}
if scan.spectral_selection.end > 1 &&
scan.ac_table_indices.iter().any(|&i| self.ac_huffman_tables[i].is_none()) {
return Err(Error::Format("scan makes use of unset ac huffman table".to_owned()));
}
if produce_data {
for (i, component) in components.iter().enumerate() {
let row_data = RowData {
index: i,
component: component.clone(),
quantization_table: self.quantization_tables[component.quantization_table_index].clone().unwrap(),
};
worker.start(row_data)?;
}
}
let blocks_per_mcu: Vec<u16> = components.iter()
.map(|c| c.horizontal_sampling_factor as u16 * c.vertical_sampling_factor as u16)
.collect();
let is_progressive = frame.coding_process == CodingProcess::DctProgressive;
let is_interleaved = components.len() > 1;
let mut dummy_block = [0i16; 64];
let mut huffman = HuffmanDecoder::new();
let mut dc_predictors = [0i16; MAX_COMPONENTS];
let mut mcus_left_until_restart = self.restart_interval;
let mut expected_rst_num = 0;
let mut eob_run = 0;
let mut mcu_row_coefficients = Vec::with_capacity(components.len());
if produce_data && !is_progressive {
for component in &components {
let coefficients_per_mcu_row = component.block_size.width as usize * component.vertical_sampling_factor as usize * 64;
mcu_row_coefficients.push(vec![0i16; coefficients_per_mcu_row]);
}
}
for mcu_y in 0 .. frame.mcu_size.height {
for mcu_x in 0 .. frame.mcu_size.width {
for (i, component) in components.iter().enumerate() {
for j in 0 .. blocks_per_mcu[i] {
let (block_x, block_y) = if is_interleaved {
(mcu_x * component.horizontal_sampling_factor as u16 + j % component.horizontal_sampling_factor as u16,
mcu_y * component.vertical_sampling_factor as u16 + j / component.horizontal_sampling_factor as u16)
}
else {
let blocks_per_row = component.block_size.width as usize;
let block_num = (mcu_y as usize * frame.mcu_size.width as usize +
mcu_x as usize) * blocks_per_mcu[i] as usize + j as usize;
let x = (block_num % blocks_per_row) as u16;
let y = (block_num / blocks_per_row) as u16;
if x * 8 >= component.size.width || y * 8 >= component.size.height {
continue;
}
(x, y)
};
let block_offset = (block_y as usize * component.block_size.width as usize + block_x as usize) * 64;
let mcu_row_offset = mcu_y as usize * component.block_size.width as usize * component.vertical_sampling_factor as usize * 64;
let coefficients = if is_progressive {
&mut self.coefficients[scan.component_indices[i]][block_offset .. block_offset + 64]
} else if produce_data {
&mut mcu_row_coefficients[i][block_offset - mcu_row_offset .. block_offset - mcu_row_offset + 64]
} else {
&mut dummy_block[..]
};
if scan.successive_approximation_high == 0 {
decode_block(&mut self.reader,
coefficients,
&mut huffman,
self.dc_huffman_tables[scan.dc_table_indices[i]].as_ref(),
self.ac_huffman_tables[scan.ac_table_indices[i]].as_ref(),
scan.spectral_selection.clone(),
scan.successive_approximation_low,
&mut eob_run,
&mut dc_predictors[i])?;
}
else {
decode_block_successive_approximation(&mut self.reader,
coefficients,
&mut huffman,
self.ac_huffman_tables[scan.ac_table_indices[i]].as_ref(),
scan.spectral_selection.clone(),
scan.successive_approximation_low,
&mut eob_run)?;
}
}
}
if self.restart_interval > 0 {
let is_last_mcu = mcu_x == frame.mcu_size.width - 1 && mcu_y == frame.mcu_size.height - 1;
mcus_left_until_restart -= 1;
if mcus_left_until_restart == 0 && !is_last_mcu {
match huffman.take_marker(&mut self.reader)? {
Some(Marker::RST(n)) => {
if n != expected_rst_num {
return Err(Error::Format(format!("found RST{} where RST{} was expected", n, expected_rst_num)));
}
huffman.reset();
dc_predictors = [0i16; MAX_COMPONENTS];
eob_run = 0;
expected_rst_num = (expected_rst_num + 1) % 8;
mcus_left_until_restart = self.restart_interval;
},
Some(marker) => return Err(Error::Format(format!("found marker {:?} inside scan where RST{} was expected", marker, expected_rst_num))),
None => return Err(Error::Format(format!("no marker found where RST{} was expected", expected_rst_num))),
}
}
}
}
if produce_data {
for (i, component) in components.iter().enumerate() {
let coefficients_per_mcu_row = component.block_size.width as usize * component.vertical_sampling_factor as usize * 64;
let row_coefficients = if is_progressive {
let offset = mcu_y as usize * coefficients_per_mcu_row;
self.coefficients[scan.component_indices[i]][offset .. offset + coefficients_per_mcu_row].to_vec()
} else {
mem::replace(&mut mcu_row_coefficients[i], vec![0i16; coefficients_per_mcu_row])
};
worker.append_row((i, row_coefficients))?;
}
}
}
let marker = huffman.take_marker(&mut self.reader)?;
if produce_data {
let mut data = vec![Vec::new(); frame.components.len()];
for (i, &component_index) in scan.component_indices.iter().enumerate() {
data[component_index] = worker.get_result(i)?;
}
Ok((marker, Some(data)))
}
else {
Ok((marker, None))
}
}
}
fn decode_block<R: Read>(reader: &mut R,
coefficients: &mut [i16],
huffman: &mut HuffmanDecoder,
dc_table: Option<&HuffmanTable>,
ac_table: Option<&HuffmanTable>,
spectral_selection: Range<u8>,
successive_approximation_low: u8,
eob_run: &mut u16,
dc_predictor: &mut i16) -> Result<()> {
debug_assert_eq!(coefficients.len(), 64);
if spectral_selection.start == 0 {
let value = huffman.decode(reader, dc_table.unwrap())?;
let diff = match value {
0 => 0,
_ => {
if value > 11 {
return Err(Error::Format("invalid DC difference magnitude category".to_owned()));
}
huffman.receive_extend(reader, value)?
},
};
*dc_predictor = dc_predictor.wrapping_add(diff);
coefficients[0] = *dc_predictor << successive_approximation_low;
}
let mut index = cmp::max(spectral_selection.start, 1);
if index < spectral_selection.end && *eob_run > 0 {
*eob_run -= 1;
return Ok(());
}
while index < spectral_selection.end {
if let Some((value, run)) = huffman.decode_fast_ac(reader, ac_table.unwrap())? {
index += run;
if index >= spectral_selection.end {
break;
}
coefficients[UNZIGZAG[index as usize] as usize] = value << successive_approximation_low;
index += 1;
}
else {
let byte = huffman.decode(reader, ac_table.unwrap())?;
let r = byte >> 4;
let s = byte & 0x0f;
if s == 0 {
match r {
15 => index += 16,
_ => {
*eob_run = (1 << r) - 1;
if r > 0 {
*eob_run += huffman.get_bits(reader, r)?;
}
break;
},
}
}
else {
index += r;
if index >= spectral_selection.end {
break;
}
coefficients[UNZIGZAG[index as usize] as usize] = huffman.receive_extend(reader, s)? << successive_approximation_low;
index += 1;
}
}
}
Ok(())
}
fn decode_block_successive_approximation<R: Read>(reader: &mut R,
coefficients: &mut [i16],
huffman: &mut HuffmanDecoder,
ac_table: Option<&HuffmanTable>,
spectral_selection: Range<u8>,
successive_approximation_low: u8,
eob_run: &mut u16) -> Result<()> {
debug_assert_eq!(coefficients.len(), 64);
let bit = 1 << successive_approximation_low;
if spectral_selection.start == 0 {
if huffman.get_bits(reader, 1)? == 1 {
coefficients[0] |= bit;
}
}
else {
if *eob_run > 0 {
*eob_run -= 1;
refine_non_zeroes(reader, coefficients, huffman, spectral_selection, 64, bit)?;
return Ok(());
}
let mut index = spectral_selection.start;
while index < spectral_selection.end {
let byte = huffman.decode(reader, ac_table.unwrap())?;
let r = byte >> 4;
let s = byte & 0x0f;
let mut zero_run_length = r;
let mut value = 0;
match s {
0 => {
match r {
15 => {
},
_ => {
*eob_run = (1 << r) - 1;
if r > 0 {
*eob_run += huffman.get_bits(reader, r)?;
}
zero_run_length = 64;
},
}
},
1 => {
if huffman.get_bits(reader, 1)? == 1 {
value = bit;
}
else {
value = -bit;
}
},
_ => return Err(Error::Format("unexpected huffman code".to_owned())),
}
let range = Range {
start: index,
end: spectral_selection.end,
};
index = refine_non_zeroes(reader, coefficients, huffman, range, zero_run_length, bit)?;
if value != 0 {
coefficients[UNZIGZAG[index as usize] as usize] = value;
}
index += 1;
}
}
Ok(())
}
fn refine_non_zeroes<R: Read>(reader: &mut R,
coefficients: &mut [i16],
huffman: &mut HuffmanDecoder,
range: Range<u8>,
zrl: u8,
bit: i16) -> Result<u8> {
debug_assert_eq!(coefficients.len(), 64);
let last = range.end - 1;
let mut zero_run_length = zrl;
for i in range {
let index = UNZIGZAG[i as usize] as usize;
if coefficients[index] == 0 {
if zero_run_length == 0 {
return Ok(i);
}
zero_run_length -= 1;
}
else if huffman.get_bits(reader, 1)? == 1 && coefficients[index] & bit == 0 {
if coefficients[index] > 0 {
coefficients[index] += bit;
}
else {
coefficients[index] -= bit;
}
}
}
Ok(last)
}
fn compute_image(components: &[Component],
data: &[Vec<u8>],
output_size: Dimensions,
is_jfif: bool,
color_transform: Option<AdobeColorTransform>) -> Result<Vec<u8>> {
if data.iter().any(|data| data.is_empty()) {
return Err(Error::Format("not all components has data".to_owned()));
}
if components.len() == 1 {
let component = &components[0];
if component.size.width % 8 == 0 && component.size.height % 8 == 0 {
return Ok(data[0].clone())
}
let mut buffer = vec![0u8; component.size.width as usize * component.size.height as usize];
let line_stride = component.block_size.width as usize * 8;
for y in 0 .. component.size.height as usize {
for x in 0 .. component.size.width as usize {
buffer[y * component.size.width as usize + x] = data[0][y * line_stride + x];
}
}
Ok(buffer)
}
else {
compute_image_parallel(components, data, output_size, is_jfif, color_transform)
}
}
#[cfg(feature="rayon")]
fn compute_image_parallel(components: &[Component],
data: &[Vec<u8>],
output_size: Dimensions,
is_jfif: bool,
color_transform: Option<AdobeColorTransform>) -> Result<Vec<u8>> {
use rayon::prelude::*;
let color_convert_func = choose_color_convert_func(components.len(), is_jfif, color_transform)?;
let upsampler = Upsampler::new(components, output_size.width, output_size.height)?;
let line_size = output_size.width as usize * components.len();
let mut image = vec![0u8; line_size * output_size.height as usize];
image.par_chunks_mut(line_size)
.with_max_len(1)
.enumerate()
.for_each(|(row, line)| {
upsampler.upsample_and_interleave_row(data, row, output_size.width as usize, line);
color_convert_func(line, output_size.width as usize);
});
Ok(image)
}
#[cfg(not(feature="rayon"))]
fn compute_image_parallel(components: &[Component],
data: &[Vec<u8>],
output_size: Dimensions,
is_jfif: bool,
color_transform: Option<AdobeColorTransform>) -> Result<Vec<u8>> {
let color_convert_func = choose_color_convert_func(components.len(), is_jfif, color_transform)?;
let upsampler = Upsampler::new(components, output_size.width, output_size.height)?;
let line_size = output_size.width as usize * components.len();
let mut image = vec![0u8; line_size * output_size.height as usize];
for (row, line) in image.chunks_mut(line_size)
.enumerate() {
upsampler.upsample_and_interleave_row(data, row, output_size.width as usize, line);
color_convert_func(line, output_size.width as usize);
}
Ok(image)
}
fn choose_color_convert_func(component_count: usize,
_is_jfif: bool,
color_transform: Option<AdobeColorTransform>)
-> Result<fn(&mut [u8], usize)> {
match component_count {
3 => {
if color_transform == Some(AdobeColorTransform::Unknown) {
Ok(color_convert_line_null)
}
else {
Ok(color_convert_line_ycbcr)
}
},
4 => {
match color_transform {
Some(AdobeColorTransform::Unknown) => Ok(color_convert_line_cmyk),
Some(_) => Ok(color_convert_line_ycck),
None => Err(Error::Format("4 components without Adobe APP14 metadata to tell color space".to_owned())),
}
},
_ => panic!(),
}
}
fn color_convert_line_null(_data: &mut [u8], _width: usize) {
}
fn color_convert_line_ycbcr(data: &mut [u8], width: usize) {
for i in 0 .. width {
let (r, g, b) = ycbcr_to_rgb(data[i * 3], data[i * 3 + 1], data[i * 3 + 2]);
data[i * 3] = r;
data[i * 3 + 1] = g;
data[i * 3 + 2] = b;
}
}
fn color_convert_line_ycck(data: &mut [u8], width: usize) {
for i in 0 .. width {
let (r, g, b) = ycbcr_to_rgb(data[i * 4], data[i * 4 + 1], data[i * 4 + 2]);
let k = data[i * 4 + 3];
data[i * 4] = r;
data[i * 4 + 1] = g;
data[i * 4 + 2] = b;
data[i * 4 + 3] = 255 - k;
}
}
fn color_convert_line_cmyk(data: &mut [u8], width: usize) {
for i in 0 .. width {
data[i * 4] = 255 - data[i * 4];
data[i * 4 + 1] = 255 - data[i * 4 + 1];
data[i * 4 + 2] = 255 - data[i * 4 + 2];
data[i * 4 + 3] = 255 - data[i * 4 + 3];
}
}
fn ycbcr_to_rgb(y: u8, cb: u8, cr: u8) -> (u8, u8, u8) {
let y = y as f32;
let cb = cb as f32 - 128.0;
let cr = cr as f32 - 128.0;
let r = y + 1.40200 * cr;
let g = y - 0.34414 * cb - 0.71414 * cr;
let b = y + 1.77200 * cb;
(clamp((r + 0.5) as i32, 0, 255) as u8,
clamp((g + 0.5) as i32, 0, 255) as u8,
clamp((b + 0.5) as i32, 0, 255) as u8)
}
fn clamp<T: PartialOrd>(value: T, min: T, max: T) -> T {
if value < min { return min; }
if value > max { return max; }
value
}