(* Copyright 2012 Tony Garnock-Jones . *) (* This file is part of Hop. *) (* Hop is free software: you can redistribute it and/or modify it *) (* under the terms of the GNU General Public License as published by the *) (* Free Software Foundation, either version 3 of the License, or (at your *) (* option) any later version. *) (* Hop is distributed in the hope that it will be useful, but *) (* WITHOUT ANY WARRANTY; without even the implied warranty of *) (* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU *) (* General Public License for more details. *) (* You should have received a copy of the GNU General Public License *) (* along with Hop. If not, see . *) open Sexp exception Amqp_exception of (int * string) let die code message = raise (Amqp_exception (code, message)) type octet_t = int type short_t = int type long_t = int32 type longlong_t = int64 type shortstr_t = string type longstr_t = string type bit_t = bool type timestamp_t = int64 type table_t = { mutable table_body: table_body_t } and table_body_t = | Encoded_table of string | Decoded_table of (string * table_value_t) list | Both_table of (string * (string * table_value_t) list) and table_value_t = | Table_bool of bool (* t *) | Table_signed_byte of int (* b *) | Table_unsigned_byte of int (* B *) | Table_signed_short of int (* U *) | Table_unsigned_short of int (* u *) | Table_signed_long of int32 (* I *) | Table_unsigned_long of int32 (* i *) | Table_signed_longlong of int64 (* L *) | Table_unsigned_longlong of int64 (* l *) | Table_float of string (* f -- there seems to be no I/O for binary floats? *) | Table_double of string (* d -- there seems to be no I/O for binary floats? *) | Table_decimal of (int * int32) (* D *) | Table_short_string of string (* s *) | Table_string of string (* S *) | Table_array of table_value_t list (* A *) | Table_timestamp of int64 (* T *) | Table_table of table_t (* F *) | Table_void (* V *) let read_octet input_buf = Ibuffer.next_byte input_buf let read_short input_buf = let hi = read_octet input_buf in let lo = read_octet input_buf in (hi lsl 8) lor lo let read_long input_buf = let hi = Int32.of_int (read_short input_buf) in let lo = Int32.of_int (read_short input_buf) in Int32.logor (Int32.shift_left hi 16) lo let read_longlong input_buf = let s0 = Int64.of_int (read_short input_buf) in let s1 = Int64.of_int (read_short input_buf) in let s2 = Int64.of_int (read_short input_buf) in let s3 = Int64.of_int (read_short input_buf) in Int64.logor (Int64.logor (Int64.shift_left s0 48) (Int64.shift_left s1 32)) (Int64.logor (Int64.shift_left s2 16) s3) let read_shortstr input_buf = let len = read_octet input_buf in Ibuffer.next_chars input_buf len let read_longstr input_buf = let len = Int32.to_int (read_long input_buf) in Ibuffer.next_chars input_buf len let read_timestamp input_buf = read_longlong input_buf let read_table input_buf = { table_body = Encoded_table (read_longstr input_buf) } let unsigned_to_signed v delta = if v >= (delta / 2) then v - delta else v let signed_to_unsigned v delta = if v < 0 then v + delta else v let rec decode_named_fields input_buf = if Ibuffer.remaining input_buf = 0 then [] else let s = read_shortstr input_buf in let f = read_table_value input_buf in (s, f) :: decode_named_fields input_buf and decode_unnamed_fields input_buf = if Ibuffer.remaining input_buf = 0 then [] else let f = read_table_value input_buf in f :: decode_unnamed_fields input_buf and read_table_value input_buf = match Ibuffer.next_char input_buf with | 't' -> Table_bool (read_octet input_buf <> 0) | 'b' -> Table_signed_byte (unsigned_to_signed (read_octet input_buf) 256) | 'B' -> Table_unsigned_byte (read_octet input_buf) | 'U' -> Table_signed_short (unsigned_to_signed (read_short input_buf) 65536) | 'u' -> Table_unsigned_short (read_short input_buf) | 'I' -> Table_signed_long (read_long input_buf) | 'i' -> Table_unsigned_long (read_long input_buf) | 'L' -> Table_signed_longlong (read_longlong input_buf) | 'l' -> Table_unsigned_longlong (read_longlong input_buf) | 'f' -> Table_float (Ibuffer.next_chars input_buf 4) | 'd' -> Table_double (Ibuffer.next_chars input_buf 8) | 'D' -> let scale = read_octet input_buf in let v = read_long input_buf in Table_decimal (scale, v) | 's' -> Table_short_string (read_shortstr input_buf) | 'S' -> Table_string (read_longstr input_buf) | 'A' -> let n = Int32.to_int (read_long input_buf) in Table_array (decode_unnamed_fields (Ibuffer.next_sub input_buf n)) | 'T' -> Table_timestamp (read_longlong input_buf) | 'F' -> Table_table { table_body = Encoded_table (read_longstr input_buf) } | 'V' -> Table_void | c -> die 502 (*syntax-error*) (Printf.sprintf "Unknown table field type code '%c'" c) and decoded_table t = match t.table_body with | Encoded_table s -> let fs = decode_named_fields (Ibuffer.create s 0 (String.length s)) in t.table_body <- Both_table (s, fs); fs | Decoded_table fs -> fs | Both_table (_, fs) -> fs let write_octet output_buf x = Obuffer.add_char output_buf (char_of_int x) let write_char output_buf x = write_octet output_buf (int_of_char x) let write_short output_buf x = write_octet output_buf ((x lsr 8) land 255); write_octet output_buf (x land 255) let write_long output_buf x = write_octet output_buf ((Int32.to_int (Int32.shift_right_logical x 24)) land 255); write_octet output_buf ((Int32.to_int (Int32.shift_right_logical x 16)) land 255); write_octet output_buf ((Int32.to_int (Int32.shift_right_logical x 8)) land 255); write_octet output_buf ((Int32.to_int x) land 255) let write_longlong output_buf x = write_octet output_buf ((Int64.to_int (Int64.shift_right_logical x 56)) land 255); write_octet output_buf ((Int64.to_int (Int64.shift_right_logical x 48)) land 255); write_octet output_buf ((Int64.to_int (Int64.shift_right_logical x 40)) land 255); write_octet output_buf ((Int64.to_int (Int64.shift_right_logical x 32)) land 255); write_octet output_buf ((Int64.to_int (Int64.shift_right_logical x 24)) land 255); write_octet output_buf ((Int64.to_int (Int64.shift_right_logical x 16)) land 255); write_octet output_buf ((Int64.to_int (Int64.shift_right_logical x 8)) land 255); write_octet output_buf ((Int64.to_int x) land 255) let write_shortstr output_buf x = let len = String.length x in write_octet output_buf len; Obuffer.add_string output_buf x let write_longstr output_buf x = write_long output_buf (Int32.of_int (String.length x)); Obuffer.add_string output_buf x let write_timestamp output_buf x = write_longlong output_buf x let rec encode_named_fields output_buf fs = match fs with [] -> () | (s, f) :: rest -> write_shortstr output_buf s; write_table_value output_buf f; encode_named_fields output_buf rest and encode_unnamed_fields output_buf fs = match fs with [] -> () | f :: rest -> write_table_value output_buf f; encode_unnamed_fields output_buf rest and write_table_value output_buf f = let wcode c = write_char output_buf c in match f with | Table_bool true -> wcode 't'; write_octet output_buf 1 | Table_bool false -> wcode 't'; write_octet output_buf 0 | Table_signed_byte v -> wcode 'b'; write_octet output_buf (signed_to_unsigned v 256) | Table_unsigned_byte v -> wcode 'B'; write_octet output_buf v | Table_signed_short v -> wcode 'U'; write_short output_buf (signed_to_unsigned v 65536) | Table_unsigned_short v -> wcode 'u'; write_short output_buf v | Table_signed_long v -> wcode 'I'; write_long output_buf v | Table_unsigned_long v -> wcode 'i'; write_long output_buf v | Table_signed_longlong v -> wcode 'L'; write_longlong output_buf v | Table_unsigned_longlong v -> wcode 'l'; write_longlong output_buf v | Table_float v -> wcode 'f'; Obuffer.add_string output_buf v | Table_double v -> wcode 'd'; Obuffer.add_string output_buf v | Table_decimal (scale, v) -> wcode 'D'; write_octet output_buf scale; write_long output_buf v | Table_short_string v -> wcode 's'; write_shortstr output_buf v | Table_string v -> wcode 'S'; write_longstr output_buf v | Table_array vs -> wcode 'A'; let buf = Obuffer.create 1024 in encode_unnamed_fields buf vs; write_longstr output_buf (Obuffer.contents buf) | Table_timestamp v -> wcode 'T'; write_longlong output_buf v | Table_table t -> wcode 'F'; write_longstr output_buf (encoded_table t) | Table_void -> wcode 'V' and encoded_table t = match t.table_body with | Encoded_table s -> s | Decoded_table fs -> let buf = Obuffer.create 1024 in encode_named_fields buf fs; let s = Obuffer.contents buf in t.table_body <- Both_table (s, fs); s | Both_table (s, _) -> s and write_table output_buf x = write_longstr output_buf (encoded_table x) let sexp_of_octet x = Str (string_of_int x) let sexp_of_short x = Str (string_of_int x) let sexp_of_long x = Str (Int32.to_string x) let sexp_of_longlong x = Str (Int64.to_string x) let sexp_of_shortstr x = Str x let sexp_of_longstr x = Str x let sexp_of_bit x = if x then Str "1" else Str "" let sexp_of_timestamp x = Str (Int64.to_string x) let rec sexp_of_table x = Hint {hint = Str "table"; body = Arr (List.map sexp_of_named_field (decoded_table x))} and sexp_of_named_field (s, f) = Arr [Str s; sexp_of_unnamed_field f] and sexp_of_unnamed_field f = let h hs v = Hint {hint = Str hs; body = v} in match f with | Table_bool true -> h "t" (Str "1") | Table_bool false -> h "t" (Str "") | Table_signed_byte v -> h "b" (sexp_of_octet (signed_to_unsigned v 256)) | Table_unsigned_byte v -> h "B" (sexp_of_octet v) | Table_signed_short v -> h "U" (sexp_of_short (signed_to_unsigned v 65536)) | Table_unsigned_short v -> h "u" (sexp_of_short v) | Table_signed_long v -> h "I" (sexp_of_long v) | Table_unsigned_long v -> h "i" (sexp_of_long v) | Table_signed_longlong v -> h "L" (sexp_of_longlong v) | Table_unsigned_longlong v -> h "l" (sexp_of_longlong v) | Table_float v -> h "f" (Str v) | Table_double v -> h "d" (Str v) | Table_decimal (scale, v) -> h "D" (Arr [Arr [Str "scale"; sexp_of_octet scale]; Arr [Str "value"; sexp_of_long v]]) | Table_short_string v -> h "s" (Str v) | Table_string v -> Str v | Table_array vs -> h "A" (Arr (List.map sexp_of_unnamed_field vs)) | Table_timestamp v -> h "T" (sexp_of_longlong v) | Table_table t -> sexp_of_table t | Table_void -> Arr [] let table_of_list fs = { table_body = Decoded_table fs } let reserved_value_octet = 0 let reserved_value_short = 0 let reserved_value_long = Int32.zero let reserved_value_longlong = Int64.zero let reserved_value_shortstr = "" let reserved_value_longstr = "" let reserved_value_bit = false let reserved_value_timestamp = Int64.zero let reserved_value_table = { table_body = Encoded_table "" } let octet_of_sexp v = match v with Str x -> int_of_string x | _ -> reserved_value_octet let short_of_sexp v = match v with Str x -> int_of_string x | _ -> reserved_value_short let long_of_sexp v = match v with Str x -> Int32.of_string x | _ -> reserved_value_long let longlong_of_sexp v = match v with Str x -> Int64.of_string x | _ -> reserved_value_longlong let shortstr_of_sexp v = match v with Str x -> x | _ -> reserved_value_shortstr let longstr_of_sexp v = match v with Str x -> x | _ -> reserved_value_longstr let bit_of_sexp v = match v with Str x -> x <> "" | _ -> reserved_value_bit let timestamp_of_sexp v = match v with Str x -> Int64.of_string x | _ -> reserved_value_timestamp let rec table_of_sexp v = match v with | Hint {hint = Str "table"; body = Arr field_sexps} -> table_of_list (List.map named_sexp_field field_sexps) | _ -> table_of_list [] and named_sexp_field v = match v with | Arr [Str s; f] -> (s, field_of_sexp f) | _ -> ("", Table_void) and field_of_sexp v = match v with | Hint {hint = Str "t"; body = Str x} -> Table_bool (x <> "") | Hint {hint = Str "b"; body = v} -> Table_signed_byte (unsigned_to_signed (octet_of_sexp v) 256) | Hint {hint = Str "B"; body = v} -> Table_unsigned_byte (octet_of_sexp v) | Hint {hint = Str "U"; body = v} -> Table_signed_short (unsigned_to_signed (short_of_sexp v) 65536) | Hint {hint = Str "u"; body = v} -> Table_unsigned_short (short_of_sexp v) | Hint {hint = Str "I"; body = v} -> Table_signed_long (long_of_sexp v) | Hint {hint = Str "i"; body = v} -> Table_unsigned_long (long_of_sexp v) | Hint {hint = Str "L"; body = v} -> Table_signed_longlong (longlong_of_sexp v) | Hint {hint = Str "l"; body = v} -> Table_unsigned_longlong (longlong_of_sexp v) | Hint {hint = Str "f"; body = (Str v)} -> Table_float v | Hint {hint = Str "d"; body = (Str v)} -> Table_double v | Hint {hint = Str "D"; body = (Arr [Arr [Str "scale"; scale]; Arr [Str "value"; v]])} -> Table_decimal (octet_of_sexp scale, long_of_sexp v) | Hint {hint = Str "s"; body = (Str v)} -> Table_short_string v | Str v -> Table_string v | Hint {hint = Str "A"; body = Arr vs} -> Table_array (List.map field_of_sexp vs) | Hint {hint = Str "T"; body = v} -> Table_timestamp (longlong_of_sexp v) | Hint {hint = Str "table"; body = _} -> Table_table (table_of_sexp v) | Arr [] -> Table_void | _ -> Table_void let field_lookup k def fs = try List.assoc k fs with Not_found -> def let field_lookup_some k fs = try Some (List.assoc k fs) with Not_found -> None let table_lookup k t = List.assoc k (decoded_table t) let table_lookup_default k def t = field_lookup k def (decoded_table t) let table_lookup_some k t = field_lookup_some k (decoded_table t)